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1.0  INTRODUCTION 


Alignment  is  the  process  of  calibrating  a  sensor  relative  to  some  standard.  Specifically,  it 
determines  the  bias  or  offset  errors  in  the  sensor  by  comparing  the  data  reported  by  the  sensor  to 
the  standard.  Alignment  is  usually  classified  as  either  absolute  or  relative,  depending  on  the  type 
of  standard.  This  classification  is  somewhat  artificial  since  any  alignment  procedure  is  fundamen¬ 
tally  a  relative  process;  that  is,  alignment  relative  to  some  standard.  However,  a  useful  distinction 
can  be  made  between  absolute  and  relative  alignment.  The  standard  used  in  absolute  alignment 
contains  no  bias  errors  with  respect  to  some  universal  standard.  Thus,  the  sensor-reported  data  can 
be  correctly  expressed  relative  to  the  universal  standard  by  absolutely  aligning  the  sensor.  How¬ 
ever,  in  relative  alignment,  the  standard  may  contain  some  bias  errors  with  respect  to  the  universal 
standard.  In  this  case,  the  sensor-reported  data  cannot  be  correctly  expressed  relative  to  the  uni¬ 
versal  standard.  Whether  this  is  a  problem  will  depend  on  the  application.  For  example,  if  the  var¬ 
ious  sensors  in  a  multisensor  system  are  relatively  aligned  to  the  same  standard,  then  all  of  the 
multisensor  data  can  be  correctly  expressed  relative  to  the  common  standard,  even  though  this 
common  standard  may  contain  bias  errors  with  respect  to  the  universal  standard.  This  may  be  suf¬ 
ficient  for  the  operation  of  the  multisensor  system. 

This  report  will  focus  on  the  absolute  alignment  of  the  positional  data  reported  by  a  tracking 
sensor.  Typically,  alignment  must  be  considered  in  tracking  applications  whenever  it  is  desired  to 
express  the  track  data  reported  by  the  sensor  in  another  reference  frame.  For  example,  alignment 
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considerations  occur  in  multisensor  tracking  applications  when  it  is  desired  to  express  the 
multisensor  track  data  in  a  common  reference  frame,  which  is  required  in  constructing  a  unified 
track  picture  of  the  environment.  The  track  data  reported  by  an  aligned  sensor  can  be  correctly 
transformed  to  any  reference  frame  that  is  also  aligned  to  the  standard.  For  an  unaligned  sensor, 
the  presence  of  any  uncompensated  aligmnent  errors  will  produce  errors  in  the  sensor’s  data  when 
it  is  transformed  to  another  frame.  These  uncompensated  alignment  errors  may  seriously  degrade 
the  performance  of  a  sensor  system.  For  example,  alignment  errors  in  a  multisensor  tracking 
system  can  cause  a  single  target  to  be  reported  at  different  locations  by  the  various  sensors  so  that 
it  appears  to  be  multiple  targets.  The  degradation  of  performance  in  a  multisensor  tracking  system 
due  to  uncompensated  alignment  errors  is  documented  in  Conte  and  Helmick^  using  simple 
simulations. 

One  source  of  alignment  errors  is  bias  errors  in  the  measurements  reported  by  the  tracking 
sensor.  Although  the  sensor  is  usually  calibrated  in  an  initial  calibration  procedure,  the  calibration 
may  deteriorate  over  time.  Another  source  of  alignment  errors  is  attitude  (or  orientation)  bias 
errors.  Most  sensors  incorporate  some  technique  to  stabilize  their  data  by  determining  the  attitude 
of  the  sensor  (e.g.,  with  a  gyroscopic  device).  Attitude  bias  errors  can  be  caused  by  offset  and  drift 
errors  in  the  gyros.  Other  sources  of  alignment  errors  include  sensor  location  bias  errors  caused  by 
offset  and  drift  errors  in  the  navigation  systems  associated  with  the  sensors  and  timing  bias  errors 
in  the  clocks  for  the  sensors.  Figure  1-1  illustrates  the  effects  of  range  bias  and  bearing  bias  errors 
in  a  radar  on  a  target  position  reported  by  the  radar.  In  this  case,  an  alignment  procedure  would 
attempt  to  estimate  the  range  and  bearing  bias  errors  by  comparing  the  positional  data  reported  by 
the  radar  to  some  standard.  Once  these  bias  errors  are  estimated,  they  can  be  removed  from  the 
positional  data  reported  by  the  radar. 
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Range  Bias  =  True  Range  -  Measured  Range 


True  Position  of  the  Target 


Measured 
Position  of  the 
Target 


Range  Bias 


HGURE  1-1.  EFFECTS  OF  RANGE  AND  BEARING  BIASES  ON  THE 
POSITION  OF  A  TARGET 


For  relative  alignment  in  multisensor  tracking  systems,  one  of  the  sensors  is  usually  chosen 
as  the  standard  and  the  other  sensors  are  aligned  to  it.  The  sensor  chosen  as  the  standard  is  called 
the  master  or  primary  sensor  and  it  is  assumed  to  be  free  of  bias  errors.  The  master  sensor  is  made 
observable  to  the  other  sensors  via  overlapping  coverage  zones  that  contain  tracks  of  common  tar¬ 
gets.  The  targets  that  are  mutually  held  by  a  sensor  and  the  master  sensor  are  used  to  determine 
the  biases  that  will  relatively  align  the  sensor  to  the  master  sensor.  This  also  explains  the  popular¬ 
ity  of  relative  alignment  procedures;  that  is,  the  ready  availability  of  mutual  track  data  bases.  A 
potential  problem  with  relative  alignment  is  that  the  master  sensor  may  not  actually  be  free  of  bias 
errors  and  thus  relative  alignment  will  produce  a  true  alignment  that  is  no  better  than  the  align¬ 
ment  accuracy  of  the  master  sensor.  Whether  this  is  a  problem  will  depend  on  the  application. 
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Another  problem  with  relative  alignment  can  arise  if  data  from  remote  sources  are  brought  into 
the  local  integrated  multisensor  system,  where  the  remote  sensor  reporting  the  data  is  not  observ¬ 
able  to  the  master  sensor.  Conversely,  problems  can  also  arise  if  data  from  the  local  integrated  sys¬ 
tem  are  sent  to  remote  systems. 

In  tracking  applications,  relative  alignment  procedures  have  been  very  popular  because  of 
the  previous  lack  of  absolute  or  universal  standards  and  the  ready  availability  of  relative  standards 
such  as  mutual  track  data  bases.  However,  with  the  advent  of  GPS  (Global  Positioning  System), 
standards  that  closely  approximate  truth  are  currently  available.  GPS  receivers  are  inexpensive 
and  accurate,  and  the  constellation  of  GPS  satellites  will  soon  be  observable  worldwide.  Thus,  it 
should  be  possible  to  use  GPS  as  an  absolute  standard  for  sensor  alignment. 

One  possible  technique  using  GPS  for  absolute  alignment  can  be  described  as  follows.  A 
cooperative  target  would  be  equipped  with  a  GPS  receiver  to  precisely  determine  its  location.  A 
communications  link  to  transmit  its  GPS-derived  location  to  the  sensor  that  is  being  absolutely 
aligned  would  be  required.  It  would  be  necessary  for  the  sensor  to  track  the  cooperative  target  and 
report  its  position.  Also,  the  sensor  to  be  aligned  would  be  equipped  with  a  GPS  receiver  to  pre¬ 
cisely  determine  its  location."^  The  absolute  alignment  technique  would  compare  the  cooperative 
target’s  position  as  reported  by  the  sensor  to  its  GPS-derived  position.  Any  differences  between 
the  sensor-reported  and  GPS-derived  positions  would  be  attributed  to  bias  errors  in  the  track  data 
reported  by  the  sensor.  Here,  the  GPS-derived  position  serves  as  the  absolute  standard  to  which 
the  sensor-reported  positions  are  aligned. 

t  The  track  Hata  reported  by  the  sensor  is  typically  expressed  in  a  reference  frame  whose  origin  is  attached 
to  the  sensor.  However,  the  GPS-derived  target  position  is  usually  expressed  in  an  earth-centered  frame. 
Comparison  of  the  GPS-derived  target  position  to  the  sensor-reported  target  position  will  require  the 
transformation  of  the  GPS-derived  position  to  the  reference  fr-ame  located  at  the  sensor  or  vice  versa.  This 
transformation  requires  the  precise  location  of  the  sensor,  which  could  also  be  determined  using  GPS. 
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This  technique  has  the  potential  for  achieving  an  accurate  absolute  alignment.  It  should  be 
fairly  simple  to  implement  from  an  algorithmic  point  of  view.  In  multisensor  applications,  the 
technique  would  avoid  the  problem  of  needing  overlapping  coverage  zones  if  all  of  the  sensors 
employed  this  technique;  the  integration  of  sensor  data  from  remote  sources  into  the  local  multi¬ 
sensor  system  and  vice  versa  would  be  less  of  a  problem;  and  the  technique  would  be  applicable 
to  widely  distributed  sensors  as  well  as  co-located  sensors. 

The  purpose  of  this  report  is  to  develop  an  algorithm  for  absolutely  aligning  the  positional 
data  reported  by  a  tracking  sensor  using  a  target  whose  location  is  measured  by  the  sensor  and 
whose  location  can  also  be  precisely  determined  independently  of  the  sensor’s  measurements. 
This  algorithm  also  requires  the  location  of  the  sensor  to  be  accurately  known.  As  stated  above, 
GPS  is  one  candidate  for  providing  precise  location  information  for  both  the  target  and  the  sensor. 
However,  the  algorithm  is  applicable  to  any  technique  that  provides  precise  location  information 
independently  of  the  sensor’s  measurements. 

This  absolute  alignment  algorithm  will  consist  of  two  basic  functions  or  modules:  (1)  the 
bias  estimation  module,  and  (2)  the  bias  correction  module.  The  purpose  of  the  bias  estimation 
module  is  to  estimate  the  bias  errors  using  the  difference  between  the  target’s  sensor-reported 
position  and  the  target’s  precise  position  that  is  determined  independently  of  the  sensor’s  mea¬ 
surements.  The  bias  correction  module  will  receive  estimates  of  the  bias  errors  from  the  bias  esti¬ 
mation  module  and  then  use  these  bias  estimates  to  compensate  (or  correct)  for  the  effects  of  the 
bias  errors  in  the  sensor’s  data.  That  is,  the  bias  correction  module  will  absolutely  align  all  of  the 
tracks  reported  by  the  sensor,  not  only  the  track  of  the  target  used  to  estimate  the  biases. 

The  main  steps  in  constructing  these  two  modules  are  to  model  the  bias  errors  and  then 
develop  equations  that  relate  the  modeled  bias  errors  to  the  true  and  sensor-reported  positions  of  a 
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target.  The  bias  estimation  module  will  apply  known  filtering  techniques  to  estimate  the  biases. 
Specifically,  the  bias  estimation  module  will  employ  two  Kalman  filters:  a  filter  to  estimate  the 
range  bias  and  another  one  to  estimate  the  angular  biases.  The  bias  correction  module  will  then 
absolutely  align  any  target  track  reported  by  the  sensor  using  the  estimated  biases  from  the  bias 
estimation  module. 

The  absolute  alignment  algorithm  will  require  data  from  several  sources:  the  system  provid¬ 
ing  the  precise  location  of  a  target  independently  of  the  sensor’s  measurements;  the  system  pro¬ 
viding  the  precise  location  of  the  sensor;  the  position  of  the  target  that  is  reported  by  the  sensor; 
and  possibly  the  attitude  of  the  sensor  if  it  is  determined  using  a  sensing  device  (e.g.,  a  gyroscopic 
device).  This  multisource  data  will  most  likely  be  asynchronous.  Since  the  alignment  algorithm 
will  require  time-coincident  or  synchronized  data,  estimation  algorithms  (i.e.,  filtering  and  predic¬ 
tion)  will  be  required  to  extrapolate  at  least  some  of  the  various  multisource  data  to  a  common 
point  in  time.  The  estimation  algorithm  used  to  filter  the  multisource  data  and  predict  the  multi¬ 
source  filtered  states  to  a  common  point  in  time  is  not  the  focus  of  this  report,  and  it  will  not  be 
examined  further.  It  will  be  assumed  that  synchronized  estimates  of  the  multisource  data  are  avail¬ 
able  for  processing  in  the  alignment  algorithm. 

This  report  is  organized  as  follows.  Section  2  presents  background  material  on  stabilizing 
the  data  reported  by  a  sensor.  Section  3  presents  the  modeling  of  the  bias  errors  and  the  develop¬ 
ment  of  the  absolute  alignment  algorithm.  Simulation  results  are  presented  in  Section  4  to  illus¬ 
trate  the  performance  of  the  alignment  algorithm.  Section  5  summarizes  the  results  of  this  effort. 
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2.0  STABILIZATION 


2.1  INTRODUCTION 

The  measurements  reported  by  a  sensor  will  be  meaningful  and  useful  only  if  they  are 
expressed  relative  to  a  known  reference.  That  is,  a  reference  frame  is  necessary  for  describing  the 
measurements  reported  by  a  sensor.  A  reference  frame  is  usually  characterized  by  three  axes  and 
the  location  of  its  origin,  which  is  the  point  of  intersection  of  the  three  axes.  One  of  the  reference 
frames  associated  with  a  sensor  is  its  measurement  frame.  The  measurement  frame  is  the  frame  in 
which  the  sensor’s  measurements  are  actually  obtained.  The  origin  of  the  measurement  frame  is 
located  at  the  sensor  and  its  axes  are  often  defined  by  the  architecture  of  the  sensor  or  of  the  plat¬ 
form  on  which  the  sensor  resides.  For  example,  in  shipboard  applications,  the  axes  of  the  mea¬ 
surement  frame  are  often  formed  by  the  fore-aft  line,  the  horizontal  line  that  is  orthogonal  to  the 
fore-aft  line,  and  the  axis  that  is  orthogonal  to  the  horizontal  plane  formed  by  the  other  two.  The 
measurement  frame  rotates  about  all  three  of  its  axes  as  the  sensor  rotates  in  pitch,  roll,  and  yaw, 
and  thus  it  is  considered  non-inertial  and  it  is  said  to  be  unstabilized.  One  source  of  the  rotations 
of  the  measurement  frame  in  pitch,  roll,  and  yaw  can  be  the  flexure  and/or  motion  of  the  platform 
on  which  the  sensor  resides. 

Although  a  sensor’s  measurements  are  actually  obtained  in  its  unstabilized  measurement 
frame,  it  is  often  better  to  transform  the  measurements  to  an  inertial  or  nonrotating  frame,  or  to  a 
frame  that  is  a  fairly  good  approximation  to  an  inertial  frame.  The  stabilized  frame  is  the  reference 
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frame  for  a  sensor  that  serves  as  an  inertial  frame  or  an  approximation  to  an  inertial  frame.  Stabi¬ 
lization  refers  to  the  process  of  compensating  for  the  attitude  (or  orientation)  of  a  sensor’s  mea¬ 
surement  frame  with  respect  to  its  stabilized  frame.  In  targeting  and  tracking  applications,  the 
stabilized  frame  is  often  the  local  tangent  frame  whose  origin  is  located  at  the  sensor’s  position  on 
the  earth  and  whose  axes  are  formed  by  the  true  north-south  horizontal  line,  the  true  east-west 
horizontal  line,  and  the  axis  that  is  orthogonal  to  the  horizontal  plane  formed  by  the  north-south 
and  east-west  lines.  Since  this  frame  rotates  with  the  earth,  it  is  only  an  approximation  to  an  iner¬ 
tial  reference  frame. 

The  stabilized  frame  at  a  particular  point  on  the  earth  is  illustrated  in  Figure  2-1.  The  axes  of 
the  stabilized  frame  are  represented  by  three  mutually  orthogonal  vectors,  where  one  of  the  vec¬ 
tors  points  eastward,  one  points  northward,  and  the  final  one  points  in  the  direction  of  an  outward 
normal  vector  (i.e.,  in  the  “up”  direction).  As  Figure  2-1  suggests,  the  orientation  of  the  stabilized 
frame  depends  on  its  location  on  the  earth;  that  is,  the  orientation  changes  at  different  points  on 
the  earth. 

Stabilization  is  usually  achieved  by  a  device  (such  as  a  gimbal)  that  mechanically  maintains 
the  alignment  of  the  sensor  to  its  stabilized  frame,  or  by  measuring  the  attitude  of  the  sensor  and 
then  using  this  attitude  to  transform  the  sensor’s  data  to  its  stabilized  frame  using  mathematical 

computations.  Specifically,  the  stabilization  technique  can  be  grouped  into  three  major  classes: 

•  Unstabilized  -  The  sensor  operates  in  a  totally  unstable  environment  and  its  data  contain  rota¬ 
tional  components  (e.g.,  pitch,  roll,  and  yaw)  with  respect  to  its  stabilized  frame.  Any  com¬ 
pensation  is  external  to  the  sensor  using  a  device  to  sense  the  attitude  of  the  sensor  with 
respect  to  its  stabilized  frame.  This  attitude  is  then  used  to  transform  the  sensor’s  data  to  its 
stabilized  frame  using  mathematical  computations. 
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HGURE  2-1.  STABILIZED  FRAME  (EAST,  NORTH,  UP)  AT  A  PARTICULAR 
POINT  ON  THE  EARTH 


•  Partially  Stabilized  -  The  sensor  is  mechanically  stabilized  along  one  axis  using  some  device, 
and  its  data  contain  rotational  components  in  the  remaining  (unstabilized)  axes.  Any  compen¬ 
sation  along  the  unstabilized  axes  is  external  to  the  sensor  and  accomplished  in  a  manner  sim¬ 
ilar  to  the  unstabilized  case. 

•  Fully  Stabilized  -  The  sensor  is  gimbal-mounted  and  the  alignment  of  the  sensor  to  its  stabi¬ 
lized  frame  is  mechanically  maintained.  Thus,  the  sensor’s  data  contain  no  rotational  compo¬ 
nents  with  respect  to  its  stabilized  frame  and  no  further  compensation  is  required. 
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Most  tracking  sensors  that  provide  positional  measurements  for  targets  can  be  classified  into 
four  distinct  types  depending  on  the  type  of  positional  measurements  they  provide: 

( 1 )  range,  bearing,  and  elevation; 

(2)  range  and  bearing; 

(3)  bearing  and  elevation; 

(4)  bearing. 

For  example,  a  precision  tracking  radar  usually  provides  measurements  of  range,  bearing,  and  ele¬ 
vation,  while  a  surveillance  radar  may  only  provide  range  and  bearing.  A  passive  infrared  search 
and  tracking  sensor  usually  provides  bearing  and  elevation,  and  an  acoustical  sensor  may  only 
provide  bearing  measurements. 

If  the  sensor  is  not  fully  mechanically  stabilized,  then  any  stabilization  of  the  unstabilized 
axes  will  be  external  to  the  sensor  using  transformation  equations  and  the  measured  attitude  of  the 
sensor.  The  transformation  equations  for  the  stabilization  are  examined  below.  It  is  possible  to 
stabilize  sensor  classes  1  and  3,  while  classes  2  and  4  can  not  be  truly  stabilized  using  only  equa¬ 
tions  because  they  do  not  provide  enough  information  to  determine  the  three-dimensional  position 
of  a  target  nor  the  unit  direction  vector  to  a  target.  Although  class  3  does  not  provide  full  three- 
dimensional  positional  information,  it  does  provide  enough  information  to  determine  the  unit 
direction  vector  to  a  target  and  this  unit  direction  vector  can  be  stabilized. 

2.2  TRANSFORMATION  EQUATIONS 

To  uniquely  describe  a  position  in  a  specific  reference  frame  requires  the  introduction  of  a 
system  of  coordinates.  Since  the  sensor  is  assumed  to  provide  measurements  of  range,  bearing. 
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and  elevation,  it  is  natural  to  use  a  spherical  coordinate  system  to  describe  a  position.  The  spheri¬ 
cal  coordinate  system  used  in  this  report  is  illustrated  in  Figure  2-2  and  it  employs  a  linear  dis¬ 
tance  and  two  angles  to  describe  a  position.  The  range  R  is  the  distance  along  the  straight  line 
from  the  sensor  (which  is  located  at  the  origin  O)  to  the  target,  the  bearing  B  is  the  angle  measured 
from  the  Y  axis  in  the  horizontal  plane  formed  by  the  X  and  Y  axes,  and  the  elevation  E  is  the  angle 
measured  above  the  horizontal  plane.  For  example,  in  the  stabilized  frame  illustrated  in 
Figure  2-1,  the  X  axis  points  eastward,  the  Y  axis  points  northward,  and  the  Z  axis  points  in  the 
“up”  direction.  Thus,  the  bearing  is  measured  from  the  north  direction  in  the  stabilized  frame  of 
Figure  2-1.  It  will  be  useful  to  introduce  a  rectangular  (or  cartesian)  coordinate  system  in  a  refer¬ 
ence  frame.  The  rectangular  coordinate  system  is  also  illustrated  in  Figure  2-2.  It  employs  three 
linear  distances  to  describe  the  position  of  a  target;  that  is,  the  distances  X,  Y,  and  Z  along  the  X,  Y, 
and  Z  axes,  respectively. 

Coordinate  conversion  is  the  process  of  changing  from  one  set  of  coordinates  that  describes 
a  point  in  a  reference  frame  to  another  system  of  coordinates  describing  the  same  point  in  the 

same  reference  frame.^  Thus,  if  the  spherical  coordinates  R,  B,  and  E  are  specified  in  a  reference 
frame,  the  conversion  to  the  rectangular  coordinates  X,  Y,  and  Z  in  the  same  reference  frame  is 
computed  using  the  following  three  equations: 

X  =  R  cosE  sinB  (2-1) 

Y  =  R  cosE  cosB  (2-2) 

Z  =  R  sinE  (2-3) 
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HGURE  2-2.  SPHERICAL  AND  RECTANGULAR  COORDINATES 
IN  THE  SAME  REFERENCE  FRAME 


Conversely,  if  the  rectangular  coordinates  X,  i;  and  Z  are  specified,  the  conversion  to  the  spherical 
coordinates  R,  B,  and  E  is  computed  using  the  following  three  equations: 


R  =  + 


(2-4) 


(2-5) 


(2-6) 
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The  process  of  stabilization  of  a  target’s  position  is  one  of  transforming  the  target’s  coordi¬ 
nates  from  the  unstabilized  measurement  frame  to  the  stabilized  frame  using  the  same  coordinate 

system.^  Both  frames  have  the  same  origin,  but  one  is  tilted  with  respect  to  the  other  one.  This 
transformation  is  most  easily  described  using  rectangular  coordinates.  The  transformation 

between  these  frames  can  be  described  by  a  set  of  Eulerian  angles.  The  xyz-convention^  is  used  in 
this  report.  In  the  xyz-convention,  the  transformation  from  the  stabilized  frame  to  the  unstabilized 
measurement  frame  is  accomplished  by  first  rotating  about  the  Z  axis  of  the  stabilized  frame  by 
the  yaw  angle  y,  then  rotating  about  the  intermediate  Y  axis  by  the  pitch  angle  p,  and  rotating 
about  the  final  X  axis  by  the  roll  angle  r  (see  Figure  2-3).  The  transformation  from  the  unstabi¬ 
lized  measurement  frame  to  the  stabilized  frame  is  obtained  by  reversing  the  above  rotations. 

Let  Xs,  Yg,  and  denote  the  rectangular  coordinates  of  a  point  in  the  stabilized  frame. 
Rotating  about  the  Z  axis  of  the  stabilized  frame  by  the  yaw  angle  y  produces  the  coordinates  Xj, 
Yj,  and  Z/  in  an  intermediate  reference  frame,  which  are  computed  by 


Xj  =  X^cosy  +  T^siny 

(2-7) 

Yj  =  -X^siny -1- y^cosy 

(2-8) 

Zj  =  Z_j 

(2-9) 

Rotating  about  the  Yj  axis  by  the  pitch  angle  p  produces  the  set  of  coordinates  Xjj,  Yji,  and 
Zji,  which  are  computed  by 


Xji  -  Xjcosp  -  ZjSinp 


(2-10) 
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Stable  Z  axis  (Up) 


FIGURE  2-3.  UNSTABILIZED  MEASUREMENT  AND  STABILIZED  FRAMES 
ALONG  WITH  THE  YAW,  PITCH,  AND  ROLL  ANGLES 


Yjj  =  Yj  (2-11) 

Zjj  -  XySinp  +  Z^cos/)  (2-12) 

Finally,  rotating  about  the  Xjj  axis  by  the  roll  angle  r  produces  the  set  of  (unstabilized)  coordinates 
Xu,  Yu,  and  Zu  in  the  measurement  frame,  which  are  computed  by 
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X^j  =  X,j  (2-13) 

=  YjjCOsr  +  ZjjSinr  (2-14) 

=  -YjjSmr  ■\-ZjjCO&r  (2-15) 

The  three  rotational  transformations  above  can  be  expressed  in  matrix  notation  by  the  fol¬ 
lowing  three  equations: 


Yi 

h 

= 

cosy  siny  0 

-siny  cosy  0 

0  0  1 

^5 

h. 

^yaw 

Ys 

h 

Xi 

hi 

= 

cosp  0  -sin/? 

0  1  0 

sinp  0  cosp 

’^7 

5/ 

=  ^ pitch 

[h 

= 

1  0  0 

0  cosr  sinr 

0  -sinr  cosr 

Xi 

hi 

=  Broil 

hi 

Yii 

hi 

(2-16) 


(2-17) 


(2-18) 


where  By^w,  BpUch  B^ou  are  each  3x3  orthogonal  matrices.  Combining  these  three  equations 
into  a  single  vector  equation  gives  the  transformation  from  the  stabilized  frame  to  the  unstabilized 
measurement  frame  as 


r 


u 


=  Br 


s 


(2-19) 
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where 


c:  , 

^5 

= 

II 

(2-20) 


and 


^  ^  rolfi pitch^ yaw 


1  0  0 
0  COST  sinr 
0  -sinr  cosr 


cosp  0  -sin/7 
0  1  0 
sinp  0  cosp_ 


COS37  siny  0 
-sinj  co&y  0 
0  0  1 


cosp  cosy  cos/7sin>  — sin/> 

(sin/7sinrcos}'- cosrsin}’)  ( sin/?  sinr  sin}' +  cosr  cos  j)  cospsinr 
(sin/?cosrcos}'+ sinrsiny)  (sin/7COsrsin>’- sinrcosy)  cospcosr 


(2-21) 


The  transformation  from  the  unstabilized  measurement  frame  to  the  stabilized  frame  is 
obtained  by  reversing  the  above  rotations: 


Tc  =  Ar 


u 


(2-22) 


where 


A 


^  yaW^  pitch^  roll 


cosy  -siny  0 
siny  cosy  0 
0  0  1 


cosp  0  sin/? 
0  1  0 
-sin/?  0  cos/? 


1  0  0 
0  cosr  -sinr 
0  sinr  cosr 


cospcosy  ( sin/?sinrcosy -  cosrsiny)  ( sin/?cosrcosy  +  sinrsiny) 
cos/?siny  (sinpsinrsiny  +  cosrcosy)  (sin/?cosrsiny- sinrcosy) 
-sin/?  cos/?  sinr  cos/?  cosr 


(2-23) 


and 
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A  =  ^  t  h  =  t  h  ^  11  =  ii  A  =  (2-24) 

yaw  yaw  pitch  pitch  roll  roll  ^  ^ 

where  the  superscript  T  denotes  matrix  transpose.  Equation  (2-22)  is  the  transformation  that  stabi¬ 
lizes  a  target’s  position  using  rectangular  coordinates. 

It  is  also  possible  to  develop  a  transformation  that  stabilizes  a  target’s  position  using  spheri¬ 
cal  coordinates.  Let  R^,  B^,  and  Es  denote  the  spherical  coordinates  of  a  point  in  the  stabihzed 
frame,  and  let  Ru,  Bfj,  and  Eu  denote  the  (unstabilized)  spherical  coordinates  of  a  point  in  the 
measurement  frame.  Here,  Ru,  Bu,  and  Eu  are  the  target’s  range,  bearing,  and  elevation  that  are 
reported  by  the  sensor  in  its  (unstabilized)  measurement  frame. 

Using  the  equations  above,  it  can  be  shown  that  the  range  is  invariant  with  respect  to  the  sta¬ 
bilizing  transformation;  that  is, 

Rs  =  +  4  =  J4+4  +  4  =  Ru  (2-25) 

The  stabilized  bearing  is  defined  by 


Bg  =  tan 


-1 


(2-26) 


It  can  be  shown  that 


-1 

Xjcosy  -  y^siny  ' 

-1 

(X/Yf)-tmy  1 

tan 

^X^siny  +  Yjcosyj 

=  tan 

[l+(X/y/)tanyJ 

(2-27) 


Defining  the  bearing  Bj  (in  the  intermediate  frame  formed  by  the  X[,  Yj,  and  Zj  axes)  by 
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tan  By  =  Xj/Yj 


(2-28) 


allows  Equation  (2-27)  to  be  expressed  as 


J  tanBy-tan)' 


^5  =  tan-  I  1  +  tanBytan^ J  =  [tan(By-y)]  =  B,-y 


(2-29) 


The  bearing  B/  in  Equation  (2-28)  is  also  given  by 


(  Y  \ 

_1 

B,  =  tan  -^  =  tan 

V^iJ 


J  XyyCOSp  +  ZyySinp 


=  tan 


=  tan 


_/  XyCOsp+  (TyySinr  +  ZyyCOsr)  sinp 


TjyCOsr-ZyySinr 


J  cosByySinByyCosp  +  (cos£yyCOsBfySinr+ sinByyCosr)  sinp 


cosByyCOsByyCOsr-  sinByySinr 


(2-30) 


The  stabilized  elevation  is  defined  by 


.  -i( 
=  sin 


(2-31) 


It  can  be  shown  that 


_j['  Zy  ']  _j['-XyySinp+ZyyCOSp 


-XySinp^  (F^sinr +  Zj^cosr)  cos/? 
fin-  j- 


(2-32) 


=  sin  |-cosEyySinByySinp+  (cosEyCOsByySinr  +  sinEjyCOsr)  cosp} 
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In  summary,  the  transformation  that  stabilizes  the  target’s  position  using  spherical  coordi¬ 
nates  is  given  by  the  following  equations: 

R,  =  (2-33) 

Bs  =  Bj-y  (2-34) 

=  sm~^  {-  cosE^jSinBijSinp  +  {cosEjjCOsBySinr  +  sinEfjCOsr)  cosp}  (2-35) 


where 


Bj  -  tan 


-1 


cosEijSmBjjCOsp  +  (cosE ^cosB ySinr  +  sinE^cos/-)  sinp 
cosEyCOsBijCOsr- sinEfjSinr 


(2-36) 


Note  that  the  stabilization  of  the  bearing  and  elevation  does  not  require  the  range;  it  only  requires 
the  unstabilized  bearing  and  unstabilized  elevation  along  with  the  yaw,  pitch,  and  roll  angles. 

The  transformation  from  the  stabilized  frame  to  the  unstabilized  measurement  frame  using 
spherical  coordinates  can  also  be  obtained  in  a  similar  manner,  and  it  is  given  by  the  following 
equations: 


(2-37) 


Bfj  =  tan 


-1 


sin  (Bg  +  y)  cosp  -  tanE^sinp 


cos  (Bg  +  y)  COST  +  [ sin  (B^  +  y)  sinp  +  tanE^cosp]  sinr 


(2-38) 


-1 


E^  =  sin  { cosE^cos  (B^  +  y)  sinr  +  [ cosf^sin  (B^  +  y)  sinp  +  sinE^cosp]  cosr}  (2-39) 
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Equation  (2-22)  is  the  transformation  that  stabilizes  a  target’s  position  using  rectangular 
coordinates  and  Equations  (2-33)  to  (2-36)  are  the  corresponding  transformation  equations  using 
spherical  coordinates.  These  equations  require  the  range,  bearing,  and  elevation  (or  their  rectangu¬ 
lar  counterparts)  reported  by  the  sensor,  along  with  the  yaw,  pitch,  and  roll  angles,  which  are  mea¬ 
sured  using  some  device  that  senses  the  attitude  of  the  sensor.  Thus,  these  equations  are  applicable 
to  a  sensor  reporting  range,  bearing,  and  elevation.  Also,  since  Equations  (2-34)  to  (2-36)  do  not 
require  the  range,  they  can  be  used  to  stabilize  a  sensor  only  reporting  bearing  and  elevation. 
However,  it  is  not  possible  to  truly  stabilize  a  sensor  only  reporting  range  and  bearing  using  trans¬ 
formation  equations  because  the  stabilization  of  the  bearing  in  Equations  (2-34)  and  (2-36) 
requires  the  elevation.  This  also  applies  to  a  sensor  only  reporting  bearing. 

For  a  sensor  only  reporting  range  and  bearing,  or  a  sensor  only  reporting  bearing,  the  best 
solution  is  to  have  a  gimbal-mounted  sensor  (i.e.,  a  fully  mechanically  stabilized  sensor)  so  that 
the  sensor’s  data  contain  no  rotational  components  with  respect  to  the  stabilized  frame  and  thus  no 
further  compensation  (i.e.,  no  transformation  equation)  is  required.  If  this  is  not  possible,  then  all 
that  can  be  done  is  to  assign  an  arbitrary  value  to  the  elevation  and  use  the  above  transformation 
equations  to  “pseudo-stabilize”  the  sensor.  For  example,  one  could  let  the  elevation  be  zero  in  the 
above  equations.  Of  course,  for  targets  with  moderate  to  large  elevations,  this  pseudo-stabilization 
procedure  may  produce  a  “stabilized”  bearing  that  is  more  unstable  than  the  unstabilized  bearing 
reported  by  the  sensor. 
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3.0  ABSOLUTE  ALIGNMENT  ALGORITHM 


3.1  INTRODUCTION 

The  absolute  alignment  algorithm  is  developed  in  this  section.  This  algorithm  will  consist  of 
two  basic  modules:  (1)  the  bias  estimation  module,  and  (2)  the  bias  correction  module.  The  pur¬ 
pose  of  the  bias  estimation  module  is  to  estimate  the  bias  errors  using  the  difference  between  a  tar¬ 
get’s  sensor-reported  position  and  its  precise  position  as  determined  by  some  absolute  standard 
that  is  independent  of  the  sensor’s  measurements.  The  bias  correction  module  will  receive  esti¬ 
mates  of  the  bias  errors  from  the  bias  estimation  module  and  then  use  these  bias  estimates  to  cor¬ 
rect  for  the  effects  of  the  bias  errors  in  the  sensor’s  data.  The  structure  of  the  alignment  algorithm 
will  depend  on  the  locations  of  the  bias  correction  and  bias  estimation  modules  relative  to  the  sen¬ 
sor’s  tracking  module.  Various  architectures  are  possible  and  they  will  be  discussed  in  Section  3.2. 
This  is  followed  in  Section  3.3  by  a  brief  overview  of  the  modeling  of  the  bias  errors.  Section  3.4 
presents  the  development  of  the  equations  that  relate  the  modeled  bias  errors  to  the  true  and 
sensor-reported  positions  of  a  target.  A  linearized  version  of  the  alignment  model  is  presented  in 
Section  3.5  and  the  nonlinear  model  is  presented  in  Section  3.6.  This  is  followed  in  Section  3.7  by 
a  discussion  of  the  bias  estimation  module.  The  estimation  of  the  bias  errors  will  use  two  filters: 
one  to  estimate  the  range  bias  and  another  one  to  estimate  the  angular  biases.  Finally,  Section  3.8 
presents  the  equations  needed  in  the  bias  correction  module  to  absolutely  align  the  various  classes 
of  sensors. 
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3.2  ALIGNMENT  ARCHITECTURES 

Various  architectures  for  integrated  alignment  and  tracking  systems  are  possible  depending 
on  the  locations  of  the  bias  correction  and  bias  estimation  modules  relative  to  the  sensor’s  tracking 
module.  For  example,  block  diagrams  for  two  possible  architectures  implementing  GPS-based 
absolute  alignment  techniques  are  illustrated  in  Figures  3-1  and  3-2.  Each  of  the  figures  depicts  a 
cooperative  target  equipped  with  a  GPS  receiver  (RCVR)  and  a  transmitter  (XMTR)  which  broad¬ 
casts  its  GPS-derived  state  to  the  sensor.  The  sensor  is  also  equipped  with  a  GPS  receiver  to  deter¬ 
mine  its  state.  An  attitude  sensing  device  (e.g.,  a  gyroscopic  device)  is  used  to  determine  the 
attitude  state  of  the  sensor  (if  the  sensor  is  not  equipped  with  an  attitude  sensing  device,  then  it  is 
assumed  that  the  sensor  is  gimbal-mounted  and  thus  fully  mechanically  stabilized).  The  sensor’s 
measurements  are  stabilized  in  the  stabilization  module  using  the  attitude  state. 

A  track-alignment  architecture  is  illustrated  in  Figure  3-1.  Both  the  bias  estimation  and  the 
bias  correction  are  performed  after  the  sensor-reported  measurements  have  been  processed  in  the 
sensor’s  tracking  module.  That  is,  the  measurements  reported  by  the  sensor  are  not  aligned  before 
they  are  processed  in  the  sensor’s  tracking  module.  The  estimation  and  correction  of  the  biases  are 
performed  at  the  track  level  rather  than  at  the  measurement  level.  Such  an  architecture  would  be 
needed  for  those  situations  where  it  was  not  possible  to  alter  the  data  processing  functions  internal 
to  the  sensor’s  system.  Rather,  one  would  only  have  access  to  the  sensor’s  track  data  base,  which 
would  be  unaligned.  However,  one  would  still  need  estimates  of  the  sensor’s  attitude  state  to 
implement  the  track-alignment  architecture.  The  cooperative  target’s  unaligned  track,  along  with 
the  estimates  of  the  attitude  state  and  the  GPS-derived  states  of  the  sensor  and  cooperative  target, 
are  used  in  the  bias  estimation  module  to  estimate  the  biases.  The  estimated  biases  are  then  used 
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FIGURE  3-2.  MEASUREMENT-ALIGNMENT  ARCHITECTURE 
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in  the  bias  correction  module  to  align  all  of  the  tracks  in  the  sensor’s  track  data  base.  Note  that 
this  technique  will  result  in  two  track  data  bases:  the  unaligned  track  data  base,  and  the  aligned 
track  data  base.  The  two  track  data  bases  are  required  because  the  sensor’s  tracking  module  pro¬ 
cesses  measurements  that  have  not  been  aligned.  Serious  degradation  in  tracking  performance  can 
occur  if  an  attempt  is  made  to  use  aligned  tracks  and  unaligned  measurements  in  the  tracking 
module. 

If  it  is  possible  to  alter  the  data  processing  functions  internal  to  the  sensor’s  system,  then  one 
could  align  the  measurements  reported  by  the  sensor  before  they  are  processed  in  the  sensor’s 
tracking  module.  Such  a  measurement-alignment  architecture  is  illustrated  in  Figure  3-2.  Here, 
the  estimation  and  correction  of  the  biases  are  performed  immediately  after  the  stabilization  of  the 
measurements.  Only  one  track  data  base  would  be  required  because  the  sensor’s  tracking  module 
processes  measurements  that  have  been  aligned,  and  thus  this  track  data  base  would  also  be 
aligned.  Another  possible  measurement  alignment  architecture  would  perform  the  estimation  and 
correction  of  the  biases  before  the  stabilization  of  the  measurements. 

3.3  MODELING  OF  THE  BIAS  ERRORS 

The  bias  errors  will  be  modeled  as  additive  offsets  to  the  reported  values  of  the  quantities. 
Temporarily  ignoring  the  random  errors  in  the  system,  the  equations  modeling  the  bias  errors  are 
given  by 


<“^(0 


=  Ryit)  +Ri,iasit) 


(3-1) 


-  Byit) 


(3-2) 
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E'ro)  = 

(3-3) 

^"■"(0  =  Pit)  +PttaAt) 

(3-4) 

=  r(() 

(3-5) 

/“^(O  =  >’(0  +ytias(f) 


(3-6) 


In  these  equations,  Ru(t),  Bi/t),  and  Ei^t)  are  the  target’s  (unstabilized)  spherical  coordinates  that 
are  reported  by  the  sensor  at  time  f,  p(t),  r(t),  and  y(t)  are  the  attitude  angles  that  give  the  sensor’s 

orientation  at  time  f,  (0  ,  (0  ,  (t) ,  (0  ,  r  (0  ,  and  (t)  are  the  cor¬ 
responding  true  values  at  time  r;  and  Bfjia/t),  EfjiaJt),  Pbias(0>  fbias(0^  ybias(0  are  the 

bias  errors  at  time  t. 


Equations  (3-1)  to  (3-3)  for  the  range,  bearing,  and  elevation  are  expressed  in  the  unstabi¬ 
lized  measurement  frame  because  the  biases  in  these  quantities  are  assumed  to  be  caused  by  off¬ 
sets  in  the  (spherical)  measurements  reported  by  the  sensor.  Since  these  measurements  occur  in 
the  unstabilized  measurement  frame  of  the  sensor,  it  is  appropriate  to  model  the  bias  errors  in  the 
unstabilized  measurement  frame.  Depending  on  the  type  of  architecture  employed,  the  target’s 
sensor-reported  spherical  coordinates  R[/t),  Bf/t),  and  Eu(t)  in  Equations  (3-1)  to  (3-3)  can  be 
either  measured  values  or  filtered  values.  In  the  measurement-alignment  architecture,  they  refer  to 
the  (unstabilized)  measured  values,  but  in  the  track-alignment  architecture  they  refer  to  the 
tracked  or  filtered  values  (but  expressed  in  the  unstabilized  measurement  frame). 
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3.4  RELATIONSHIP  BETWEEN  THE  MODELED  BIAS  ERRORS  AND  THE  TRUE  AND 

SENSOR-REPORTED  POSITIONS  OF  A  TARGET 

The  relationship  between  the  modeled  bias  errors  and  the  true  and  reported  positions  of  a  tar¬ 
get  can  be  developed  either  in  rectangular  coordinates  or  in  spherical  coordinates.  Simulations 
have  shown  that  a  scaling  problem  may  arise  if  all  of  the  biases  are  estimated  in  a  single  filter 
based  on  a  linear  approximation  developed  in  rectangular  coordinates.  The  reason  is  that  a  linear 
distance  (i.e.,  the  range  bias)  and  angular  quantities  (i.e.,  the  angular  biases)  are  estimated  in  a  sin¬ 
gle  filter.  If  the  alignment  error  due  to  the  range  bias  is  much  smaller  than  the  alignment  error 
caused  by  the  angular  biases,  then  it  is  extremely  difficult  to  obtain  precise  range  bias  estimates. 
However,  it  is  possible  to  manipulate  the  equations  so  that  the  range  bias  decouples  from  the 
angular  biases.  This  decoupling  has  the  salutary  effect  of  negating  any  scaling  problems  that  may 
occur  because  the  decoupling  allows  the  range  bias  to  be  estimated  independently  of  the  angular 

biases  and  vice  versa.  For  the  relative  alignment  problem  considered  by  Helmick  et  this 
decoupling  is  accomplished  by  first  linearizing  the  equations  in  rectangular  coordinates  by  assum¬ 
ing  that  the  bias  errors  are  small  quantities  and  using  a  first-order  Taylor  series  expansion.  Manip¬ 
ulations  of  the  linearized  equations  are  then  performed  to  express  them  in  spherical  coordinates, 
which  results  in  the  range  bias  equation  decoupling  from  the  angular  bias  equations  and  vice 
versa.  Since  this  is  a  circuitous  route  to  obtaining  the  alignment  equations  in  spherical  coordi¬ 
nates,  it  is  easier  to  develop  the  alignment  relationships  in  spherical  coordinates  from  the  begin¬ 
ning  using  the  transformations  shown  in  Equations  (2-33)  to  (2-36).  Here,  the  range  bias  and 
angular  biases  will  be  decoupled  from  the  beginning.  Also,  no  smallness  assumptions  on  the  range 
bias  and  angular  biases  are  required.  This  is  the  approach  that  will  be  followed  below. 
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The  transformation  that  stabilizes  the  target’s  reported  position  in  spherical  coordinates 

using  the  reported  attitude  angles  is  given  by  Equations  (2-33)  to  (2-36).  These  equations  can  be 

expressed  as 

(3-7) 

=  f(By,Ey,p,r,y) 

(3-8) 

E^  —  S  F’ 

(3-9) 

where  the  functions  /and  g  are  defined  by 

j  1 M  {Bfj,  Ejj,  p,  r)  1 

f(.B  y.  E  p,  r,  y)  =tsr,  J 

(3-10) 

g  (Bfj,  E^,  p,  r)  =  sin~^  {  w  (By,  Ey,  p,  r)  } 

(3-11) 

and  the  functions  u,  v,  and  w  are  defined  by 

u  (By,  Ey,p,  r)  =  cosEySXnByCOsp  +  (cosE yCOsB ySmr  +  sinEy 

cost)  sinp  (3-12) 

v(By,Ey,r)  =  cosEyCosByCosr-sinEySinr 

(3-13) 

w  Ejj,  p,r)  =  -  cos£f,sinJ5f;Sin/7  +  (cos£j,cos£j;Sinr  +  sin^^^CGsr)  cosp  (3-14) 

For  simplicity,  we  have  dropped  the  time  notation  t  introduced  in  Section  3.3.  All  of  the  quantities 
in  the  above  equations  are  assumed  to  be  valid  at  time  t. 
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The  transformation  that  stabilizes  the  target’s  true  position  in  spherical  coordinates  using  the 
true  attitude  angles  is  given  by  the  following  equations 


jy^rue  true 


(3-15) 


^true  r  .  T^true  „true  true  true  true. 

=f  (By  ,Efj  ,p  ,r  ,y  ) 


(3-16) 


^true  /  r.^rue  „true  true  true. 
=  SiBfj  ,Eij  ,p  ,r  ) 


(3-17) 


Substituting  Equations  (3-1)  to  (3-7)  into  these  equations  gives 


RT  =  Rs^Rbias 


(3-18) 


RT  =  f^Ru  +  Rbias^  Ru  +  Rbias^  P  +Pbias^^  +  ^bias’  y  +  )  (3-19) 

eT  =  SiB^  +  B,.^^,E^  +  E,.^^,p+p,.^^,r  +  r,.J  (3-20) 

Equations  (3-18)  to  (3-20)  are  the  fundamental  equations  for  absolute  alignment.  They  relate  the 
modeled  bias  errors  to  the  true  and  reported  positions  of  a  target  in  spherical  coordinates.  Note 
that  Equation  (3-18)  for  the  range  bias  is  decoupled  from  Equations  (3-19)  and  (3-20)  for  the 
angular  biases,  and  vice  versa.  Also,  the  range  bias  equation  is  a  linear  function  of  the  range  bias, 
while  the  remaining  two  equations  are  nonlinear  functions  of  the  angular  biases. 

If  the  estimates  of  the  biases  are  available,  these  three  equations  can  be  used  to  align  the 
positions  of  the  targets  reported  by  the  sensor.  In  this  case,  the  true  values  of  the  range,  bearing. 
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and  elevation  will  represent  the  aligned  positional  coordinates  in  the  stabilized  frame.  Conversely, 
if  the  above  equations  are  used  to  estimate  the  biases,  the  true  values  of  the  range,  bearing,  and 
elevation  that  are  required  for  a  target  in  the  stabilized  frame  are  assumed  to  be  available  from  an 
absolute  standard  such  as  GPS.  However,  simulations  have  shown  that  observability  problems  are 
encountered  if  an  attempt  is  made  to  estimate  all  of  the  angular  biases.  In  particular,  it  is  difficult 
to  separate  the  effects  of  the  bearing  and  yaw  biases  in  the  data.  The  basic  problem  is  that  the  ori¬ 
entations  of  the  stabilized  frame  and  the  unstabilized  measurement  frame  are  only  slightly  differ¬ 
ent  when  the  magnitudes  of  the  pitch  and  roll  angles  are  small  and,  in  this  case,  the  bearing  and 
yaw  biases  represent  rotations  about  axes  that  are  nearly  parallel.  This  difficulty  is  most  easily 
demonstrated  by  examining  the  linearized  versions  of  the  above  alignment  equations. 

3.5  LINEAR  ALIGNMENT  MODEL 

A  linearized  version  of  the  alignment  equations  will  be  obtained  by  assuming  that  the  mag¬ 
nitudes  of  the  angular  biases  are  small  quantities  and  by  using  a  first-order  Taylor  series  expansion 
in  Equations  (3-19)  and  (3-20).  Note  that  Equation  (3-18)  for  the  range  bias  is  already  linear  and 
thus  it  does  not  have  to  be  linearized.  The  linear  alignment  model  will  be  applicable  to  those  situ¬ 
ations  where  the  magnitudes  of  the  angular  bias  errors  are  small. 

Expanding  Equations  (3-19)  and  (3-20)  about  the  reported  values  of  the  quantities  using  a 
first-order  Taylor  series  expansion  gives  the  following  approximations  to  the  angular  alignment 
equations: 


3-10 


NSWCDD/TR-96/46 


E^J,p,r,  y  )  +  (df/dB^j)  ■  +  (df/dE^j)  ■  + 

(3//5p)  •  +  0//3A-)  •  +  0//ay)  •  ybias 

=  +  0//9fi^)  •  +  0//a£^)  •  + 

0//5p)  Pbias^ 

Efr-8iBa,E^,p,r)  +  -5^.^^+  Og/a^^)  + 

(dg/dp)  Pbias+  i^g/^r) 

(3  22) 

=  £5  +  0«/a£„)  •  +  Os/3£„)  ■  £*,„  + 

(Sg/Sp)  ■Pt,„+  (3*/3r)  ■ 

^bias 

where  all  of  the  partial  derivatives  are  evaluated  at  the  reported  values  of  the  quantities  (i.e.,  at  Ry, 
By,  Ey,  p,  r,  and  y).  These  partial  derivatives  are  obtained  by  differentiating  Equations  (3-10)  to 
(3-14)  with  respect  to  the  appropriate  variable,  and  they  are  given  by 


a/  1 

f  ‘  1 

1”  du  av 

dg  1  aw 

3B„-I 

’•“v 

a/  1 

(  '  1 

r  du  av 

dg  1  aw 

3£„-l 

L"  a£^-«  a£^J 

Jl-w^ 

(3-23) 


(3-24) 


dg  1  aw 


(3-25) 


(3-26) 


(3-27) 
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and 


3w  3v  3w 

=  a  -  cosEj,  =  -cosEfjSmByCosr  =  -P  •  cosE^  (3-28) 


dB 


u 


'U  dB 


u 


dB 


u 


and 


Bu  .  „  .  „ 

=  -smEfjSmB  ijcosp  -  y  •  smp 

aLjj 


3w 


dv 


dE 


u 


=  -c 


=  sinEy&inBySinp-y-  cosp 


(3-29) 


du 

dp 


=  w 


dv 

dp 


=  0 


dp 


=  -u 


(3-30) 


du 

^  =  vsinp 


dv 

dr 


^  =  -11 


dw 

^  =  V  •  cosp 


(3-31) 


a 


=  cosByCosp- sinBySinrsinp  P  =  cosB^^sinp  +  sinfij^sinrcosp  (3-32) 


Y=  sinE^jCOsB^smr- cosEyCOsr  ^  =  smEyCosByCosr+ cosE^sinr  (3-33) 


Ti  =  cosEyCOsBySinr+  sinE^cosr 


(3-34) 


Simulations  have  shown  that  observability  problems  are  encountered  if  an  attempt  is  made  to 
estimate  all  of  the  angular  biases.  The  problem  is  that  it  is  difficult  to  estimate  both  the  bearing 
and  yaw  biases.  This  is  due  to  the  orientations  of  the  stabilized  frame  and  the  unstabilized  mea¬ 
surement  frame  being  only  slightly  different  when  the  magnitudes  of  the  pitch  and  roll  angles  are 
small.  In  this  case,  the  bearing  and  yaw  biases  represent  rotations  about  axes  that  are  nearly 
parallel. 
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This  observability  problem  is  most  easily  demonstrated  by  examining  the  coefficients  for  the 
biases  in  Equations  (3-21)  and  (3-22).  Assuming  that  the  magnitudes  of  the  pitch  and  roll  angles 
are  small,  the  first-order  approximations  of  the  bias  terms  in  Equations  (3-21)  and  (3-22)  are  given 
by 


0//3s„) 

(df/dp)  'Phias^  Pbias 

0//ar) 

(dg/dB^) 

(dg/dp)  ■  =  -  ( sinfij,) 


(df/dE^) 

ybias  =  -ytias  (3-35) 

(dg/dE^) 

^  ^  (3-36) 

Qg/dr) 


In  this  case,  the  linear  angular  alignment  equations  reduce  to 

(^bias  -  ybias)  +  ( tanEj,cosB^)  p^.^^  +  ( tan£j;Sin5j,)  (3-37) 

C'--Es  +  £sto-  (stoS„)P»^.+  (cosB(,)r,,„  (3-38) 

It  is  clear  from  these  equations  that  the  bearing  bias  and  the  yaw  bias  are  linearly  dependent 
when  the  magnitudes  of  the  pitch  and  roll  angles  are  small.  Rather  than  futilely  attempting  to  esti¬ 
mate  the  individual  bearing  and  yaw  biases,  this  implies  that  it  is  more  appropriate  to  estimate  an 
azimuth  bias  ,  which  is  the  linear  combination  given  by 


^bias  ^bias  yb 


las  ’ 


(3-39) 
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when  the  pitch  and  roll  angles  are  small.  In  simulations,  problems  have  been  encountered  in  esti¬ 
mating  the  bearing  and  yaw  biases  even  for  pitch  and  roll  angles  of  large  magnitudes.  Thus, 
Equation  (3-39)  will  be  used  even  if  the  magnitudes  of  the  pitch  and  roll  angles  are  not  small. 

The  azimuth  bias  includes  the  effects  of  both  the  bearing  bias  and  the  yaw  bias 
ybias  •  question  remains  as  to  how  the  azimuth  bias  will  be  used  in  the  alignment  equations.  It 
will  be  modeled  as  an  additive  offset  to  the  bearing;  that  is.  Equation  (3-2)  becomes 

bT  =  (3-40) 

Since  the  azimuth  bias  includes  the  effects  of  the  yaw  bias,  the  true  yaw  angle  in  Equation  (3-6) 
becomes 


true 

y  =  y 


(3-41) 


Thus,  the  general  linear  alignment  model  is  given  by  the  following  three  equations: 


R 


true 

S 


=  ^S'^^bias 


(3-42) 


-^bias^ 

idf/dp)  ■  +  (df/dr)  ■ 

^bias 


(3-43) 


eT  =  Es+  idg/dB^)  ■  +  {hg/dE^j)  • 

9g/dp)  (dg/dr) 

This  linear  alignment  model  will  be  applicable  to  those  situations  where  the  magnitudes  of  the 
angular  bias  errors  are  small.  Note  that  it  does  not  require  any  smallness  assumption  on  the  mag¬ 
nitude  of  the  range  bias. 
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3.6  NONLINEAR  ALIGNMENT  MODEL 

The  general  nonlinear  alignment  model  from  Section  3.4  is  now  given  by  the  following  three 
equations: 


RT  =  Rs^hias  (3-45) 

RT  =f^Ru-^\ias^Rv^Rbias^P-^Pbias^^+^bias^y)  (3-46) 

Rs  ~  ^  V ^bias^  R U'^R bias’ P'^P bias’ ^'^^bias^  (3-47) 

These  equations  relate  the  modeled  bias  errors  to  the  true  position  and  the  sensor-reported  posi¬ 
tion  of  a  target  using  spherical  coordinates.  Note  that  no  smallness  assumptions  on  the  range  bias 
and  angular  biases  are  required  in  the  above  nonlinear  alignment  model. 

3.7  BIAS  ESTIMATION  MODULE 

The  bias  estimation  module  produces  estimates  of  the  bias  errors  by  comparing  a  target’s 
sensor-reported  position  to  its  precise  position  as  determined  by  some  absolute  standard.  The  fun¬ 
damental  equations  used  to  develop  the  filters  in  the  bias  estimation  module  are  Equations  (3-45) 
to  (3-47)  for  the  nonlinear  alignment  model  or  Equations  (3-42)  to  (3-44)  for  the  linear  model.  In 
the  bias  estimation  module,  these  equations  are  applied  to  one  or  more  sensor-reported  targets 
whose  positions  can  also  be  determined  by  some  absolute  standard  that  is  independent  of  the  sen¬ 
sor’s  measurements. 
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The  true  position  of  the  target  is  modeled  as  the  sum  of  its  position  as  determined  by  some 
absolute  standard  plus  a  random  error  term.  That  is,  the  true  (rectangular  coordinate)  position  vec¬ 
tor  in  the  (true)  stabilized  frame  of  the  sensor  is  given  by^ 


true  std  std 

=  Tc  +c. 


(3-48) 


where  is  the  (rectangular  coordinate)  position  vector  of  the  target  that  is  determined  using  the 

absolute  standard  and  is  the  corresponding  random  error  in  the  absolute  standard.  Assuming 

that  the  magnitude  of  the  random  error  vector  is  small,  the  first-order  approximation  of 
Equation  (3-48)  in  spherical  coordinates  can  be  expressed  as 

<"  =  sf+4;'  (3.49) 

Bp  =  sf+e“;'  (3-50) 

£“‘  =  4"' +4;*  (3-51) 


where  R 


Std 

S 


,  and  Ef^ 


td 


are  the  range,  bearing,  and  elevation  of  the  target  based  on  the  abso- 


t  Since  the  alignment  will  be  performed  in  the  stabilized  frame  whose  origin  is  attached  to  the  sensor,  the 
position  vectors  and  error  vector  in  Equation  (3-48)  are  assumed  to  be  expressed  in  this  stabilized  frame. 
However,  the  target  position  as  determined  by  the  absolute  standard  will  probably  be  expressed  in  another 
frame  (e.g.,  an  earth-centered  frame  if  GPS  is  used  as  the  absolute  standard).  Thus,  it  is  assumed  that  the 
transformation  of  the  target  position  as  determined  by  the  absolute  standard  to  the  stabilized  frame  has 
been  previously  performed  and  it  is  available  for  use  in  Equation  (3-48).  Note  that  this  transformation 
needs  the  location  of  the  sensor,  which  leads  to  our  requirement  that  the  precise  location  of  the  sensor  is 
also  determined  using  an  absolute  standard. 
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lute  standard,  and  ,  and  are  the  corresponding  random  errors.  The  statistics  of  these 

random  errors  are  assumed  known. 

Using  Equations  (3-49)  to  (3-51)  in  Equations  (3-45)  to  (3-47),  the  nonlinear  alignment 
model  can  now  be  expressed  as 


-  ^S'^^bias 


(3-52) 


/  (BfJ  +  Ey  +  +  Cg^y  ^  P  1,1^^  +  , 


std 


(3-53) 


~  SiBy  +  Af^.^^  +  eg^yEy  +  Ef^^^^  +  eg^y 

,  (3-54) 

P+Pbias-*-^p^^-^^bia.  +  ^r)-^E, 

where  we  have  included  the  random  errors  y  e„  y  ,  e„,  e,,  and  e„  in  the  sensor-reported 

p  *  y 

positions  and  the  attitude  angles.  The  statistics  of  these  random  errors  are  assumed  known. 

Assuming  that  the  magnitudes  of  these  random  errors  are  small,  the  first-order  approxima¬ 
tion  of  the  nonlinear  model  is  given  by 

=  +  (3-55) 

std 

Bs  =  f(By  +  Ag^^^y  Ey  +  Eg.^^y  P  +  P g.^^yK  +  Kg.^^y  ^  )  +  gg  (3-56) 

Efg""  =  g  (By  +  Ag.^^y  Ey  +  E g.^^y  P  +  P g^^^y  V  +  V g^^^  )  +  Cg  (3-57) 
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where  the  random  error  terms  e^,  eg,  and  eg  can  be  shown  to  be  given  by 


std 

^  D  *~~^P 


(3-58) 


Std 


(3-59) 


std 

^  J7  ”  ^ /r  ^  J7 


(3-60) 


and  Bj,  ,  Bb  ,  and  b^  are  the  errors  in  the  sensor-reported  data  in  the  stabilized  frame,  which  are 

Ks  iic 


given  by 


B 


Rs 


(3-61) 


6g  =  (df/dB^)  Bg  +  (df/dE^j)  ■  +  idf/dp)  b  + 

'  ^  (3-62) 

(df/dr)  ■B^+  (df/dy)  ■  b^ 

^Es  ~  •  B^^  +  (dg/dp)  •  Bp  +  (dg/dr)  •  b^  (3-63) 

Ignoring  any  correlations  between  the  random  errors  in  the  ranges  and  the  random  errors  in 
the  angular  quantities  allows  us  to  use  two  decoupled  filters  to  estimate  the  biases.  A  linear 

Kalman  filter^’^  can  be  used  to  estimate  the  range  bias,  where  Equation  (3-55)  serves  as  the  linear 
measurement  equation.  (This  also  assumes  a  linear  dynamical  model  for  the  range  bias.)  An 

extended  Kalman  filter*’^  or  an  iterated  extended  Kalman  filter*’^  can  be  used  to  estimate  the 
angular  biases,  where  Equations  (3-56)  and  (3-57)  serve  as  the  nonlinear  measurement  equations. 
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-  Es  =  +  0«/3£i,)  ■ 

(dg/dp)  ■Phias  +  rtias  +  ^E 

Again,  ignoring  any  correlations  between  the  random  errors  in  the  ranges  and  the  random  errors  in 
the  angular  quantities  allows  us  to  use  two  decoupled  filters  to  estimate  the  biases.  A  linear 
Kalman  filter  can  be  used  to  estimate  the  range  bias,  where  Equation  (3-64)  serves  as  the  linear 
measurement  equation.  A  linear  Kalman  filter  can  also  be  used  to  estimate  the  angular  biases, 
where  Equations  (3-65)  and  (3-66)  serve  as  the  linear  measurement  equations.  (This  also  assumes 
a  linear  dynamical  model  for  the  angular  biases.) 

One  or  more  targets  are  designated  for  use  in  the  bias  estimation  module  to  determine  the 
values  of  the  bias  errors.  The  positions  of  these  targets  must  be  reported  by  the  sensor  and,  in 
addition,  the  positions  of  these  targets  must  also  be  provided  by  some  absolute  standard  that  is 
independent  of  the  sensor’s  measurements.  One  cycle  of  the  bias  estimation  processing  for  one  of 
these  targets  is  briefly  summarized  in  the  following  steps: 
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1.  The  estimation  of  the  biases  using  the  target’s  sensor-reported  position  at  time  t  begins  with 
the  following  spherical  coordinates  in  the  stabilized  frame: 

•^5  (0  > 

In  the  measurement-alignment  architecture,  these  are  the  (stabilized)  positional  measure¬ 
ments,  but  in  the  track-alignment  architecture  they  represent  the  track-level  positional  data. 
The  covariances  for  the  errors  in  these  quantities  are  assumed  known.  For  the  track-alignment 
architecture,  these  covariances  are  usually  supplied  by  the  tracking  filter.  However,  for  the 
measurement-alignment  architecture,  they  can  be  computed  using  Equations  (3-61)  to  (3-63) 
and  the  assumed  covariances  for  the  (unstabilized)  sensor-reported  measurements  and  the 
covariances  in  the  attitude  states. 

2.  Obtain  the  attitude  state,  the  state  of  the  target  as  determined  by  the  absolute  standard,  and  the 
state  of  the  sensor  as  determined  by  the  absolute  standard  that  are  valid  at  time  t.  This  may 
require  either  extrapolation  or  interpolation  of  the  available  states  to  time  t.  In  any  case,  the 
following  are  assumed  available  at  time  t: 

Attitude  Angles:  p(t),r(t),y(t) 

std 

Target’s  Position  Vector  from  the  Absolute  Standard:  ^target 

std 

Sensor’s  Position  Vector  from  the  Absolute  Standard:  r censor  ( 

The  covariances  for  the  uncertainties  in  these  quantities  are  assumed  known. 
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3.  The  position  vectors  and  are  used  to  compute  the  position  vector 

(t)  of  the  target  in  the  stabilized  frame  of  the  sensor.*  The  position  vector  (t)  is  then 

converted  to  spherical  coordinates,  which  gives  (t)  ,  ^  (0  ,  and  (t) .  The  covari¬ 

ances  for  the  errors  in  these  quantities  are  assumed  known. 

4.  Use  Equations  (2-37)  to  (2-39)  to  transform  (r)  (from  Step  1)  to  the  unsta¬ 

bilized  measurement  frame,  which  gives 


BfJ  (0  ,  By  (r).,  Ey  {t) 

5.  The  bias  estimates  and  corresponding  covariances  from  the  previous  bias  estimation  cycle  are 
predicted  to  time  t  using  the  assumed  dynamical  model  for  the  biases. 


6.  The  predicted  bias  estimates,  the  attitude  state,  the  absolutely-determined  (spherical)  coordi¬ 
nates  of  the  target,  and  the  sensor-reported  (spherical)  coordinates  of  the  target  are  used  to 
update  the  biases  at  time  t.  A  linear  Kalman  filter  is  used  to  estimate  the  range  bias,  where 

$  For  example,  if  the  position  vectors  and  ,  which  are  determined  using  some  absolute  stan¬ 
dard,  are  rectangular  position  vectors  that  are  expressed  in  an  earth-centered  frame,  then 


std  std  std 

r  =  r  — r 

target  sensor 


is  the  position  vector  of  the  target  relative  to  the  sensor.  The  vector  is  in  the  reference  frame  that  is 
parallel  to  the  earth-centered  frame  and  whose  origin  is  located  at  the  sensor.  This  vector  can  be  rotated 
into  the  stabilized  frame  of  the  sensor  using  the  transformation 


std  .  std 

rj  =Ar 


where  r^‘‘  is  the  position  vector  of  the  target  in  the  sensor’s  stabilized  frame  and  A  is  the  rotation  matrix 
given  by 

r 

-sin  A,  cosX  0 

-cosXsin(ti  -sinXsin(t)  cos(|) 

[  cosXcos(|)  sinXcos(t)  sin<|) 

where  X  and  <|)  are  the  longitude  and  latitude  for  the  sensor,  respectively. 


A  =: 
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Equation  (3-55)  is  used  as  the  measurement  equation.  If  an  extended  Kalman  filter  or  an  iter¬ 
ated  extended  Kalman  filter  is  used  to  estimate  the  angular  biases,  then  Equations  (3-56)  and 
(3-57)  are  used  as  the  measurement  equations.  If  a  linear  Kalman  is  used  to  estimate  the  angu¬ 
lar  biases,  then  Equations  (3-65)  and  (3-66)  are  used  as  the  measurement  equations. 
Equations  (3-58)  to  (3-60)  can  be  used  to  compute  the  covariances  for  the  measurement  noise 
terms  in  these  equations. 

The  above  bias  estimation  procedure  applies  to  a  sensor  measuring  range,  bearing,  and  ele¬ 
vation.  For  a  sensor  only  measuring  bearing  and  elevation,  the  same  angular  bias  filter  as 
described  in  Step  6  above  is  used;  however,  no  range  bias  filter  is  required.  For  a  sensor  only  mea¬ 
suring  range  and  bearing.  Step  6  uses  the  same  linear  Kalman  filter  to  estimate  the  range  bias,  but 
uses  only  Equation  (3-56)  to  estimate  the  angular  biases  for  the  nonlinear  model  or 
Equation  (3-65)  for  the  linear  model.  The  elevation  (t)  is  needed  in  Step  4  for  the  computation 

of  By  (t)  and  Ey{t)  .  Since  E^  (t)  is  not  provided  by  a  sensor  only  measuring  range  and  bear¬ 
ing,  one  lets  E^it)  =  Ef^^  (t)  in  Step  4  for  this  case.  That  is,  the  elevation  as  determined  by  the 

absolute  standard  is  assigned  to  the  target’s  sensor-reported  position.  This  also  implies  that  the 
elevation  bias  is  zero  and  thus  it  does  not  have  to  be  estimated.  Finally,  for  a  sensor  only  measur¬ 
ing  the  bearing,  no  range  bias  filter  is  required,  and  Equation  (3-56)  is  used  in  the  angular  bias  fil¬ 
ter  for  the  nonlinear  model  or  Equation  (3-65)  for  the  linear  model.  Again,  since  E^{t)  is  not 

provided,  one  lets  E^{t)  =  Ej^  (0  in  Step  4  and  no  elevation  bias  is  estimated. 
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3.8  BIAS  CORRECTION  MODULE 

Once  bias  estimates  are  available  from  the  bias  estimation  module,  the  bias  correction  mod¬ 
ule  is  used  to  absolutely  align  all  of  the  sensor’s  data  using  the  estimated  biases.  Note  that  the  bias 
correction  module  aligns  the  data  for  all  of  the  targets  reported  by  the  sensor,  not  only  the  target(s) 
used  to  estimate  the  biases.  The  alignment  of  any  sensor-reported  target  data  in  the  bias  correction 
module  is  summarized  in  the  following  steps: 

1.  The  absolute  alignment  of  any  target’s  data  at  time  t  starts  with  its  sensor-reported  (spherical) 
position  in  the  stabilized  frame: 

■^5  (0  »  ^5  (0  > 

In  the  measurement-alignment  architecture,  these  are  the  (stabilized)  positional  measure¬ 
ments,  but  in  the  track-alignment  architecture  they  represent  the  track-level  positional  data. 

2.  Obtain  the  attitude  state  of  the  sensor  and  the  bias  estimates  that  are  valid  at  time  t.  This  may 
require  either  extrapolation  or  interpolation  of  the  available  attitude  states  and  bias  estimates 
to  time  t.  In  any  case,  the  following  are  assumed  to  be  available  at  time  t: 

Attitude  Angles:  p{t),r(t),y{t) 

Bias  Estimates:  «) ,  Xt,,, «) .  (0 

3.  Use  Equations  (2-37)  to  (2-39)  to  transform  (t) ,  (t) ,  (t)  (from  Step  1)  to  the  unsta¬ 

bilized  measurement  frame  at  time  t,  which  gives 

(0  >  (0 
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where  (t) ,  (t) ,  and  represent  the  absolutely  aligned  positional 

data  in  the  stabilized  frame. 

The  above  bias  correction  procedure  applies  to  a  sensor  reporting  range,  bearing,  and  eleva¬ 
tion.  The  above  procedure  also  applies  to  a  sensor  only  reporting  bearing  and  elevation  if 
Equation  (3-67)  is  ignored.  However,  for  a  sensor  only  reporting  range  and  bearing,  or  a  sensor 
only  reporting  bearing,  then  all  that  can  be  done  is  to  “pseudo-align”  the  bearing.  For  example, 
one  could  assign  arbitrary  values  (e.g.,  zeros)  to  the  required  elevation  and  elevation  bias  in  the 
bearing  alignment  equation. 
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4.0  SIMULATIONS 


4.1  INTRODUCTION 

The  absolute  alignment  algorithm  was  tested  by  simulating  a  tracking  sensor  and  including 
both  bias  and  random  errors  in  the  data  reported  by  the  sensor.  The  algorithm  was  tested  for  a 
tracking  sensor  measuring  range,  bearing,  and  elevation,  and  for  a  sensor  only  measuring  range 
and  bearing.  Since  the  estimation  of  the  angular  biases  is  decoupled  from  the  estimation  of  the 
range  bias,  the  simulation  results  for  the  angular  biases  obtained  for  a  tracking  sensor  measuring 
range,  bearing,  and  elevation  will  be  the  same  as  for  a  sensor  only  measuring  bearing  and  eleva¬ 
tion  and  having  the  same  accuracies  for  the  bearing  and  elevation  measurements  as  the  sensor 
measuring  range,  bearing,  and  elevation.  Similarly,  the  simulation  results  for  the  angular  biases 
obtained  for  a  tracking  sensor  only  measuring  range  and  bearing  will  be  the  same  as  for  a  sensor 
only  measuring  bearing  and  having  the  same  accuracy  for  the  bearing  measurements  as  the  sensor 
measuring  range  and  bearing.  Thus,  the  alignment  algorithm  has  been  simulated  for  the  four  most 
common  types  of  tracking  sensors  providing  positional  data. 

The  simulated  alignment  algorithm  processed  the  measurements  reported  by  the  sensor 
rather  than  track-level  data.  Various  targets,  each  having  a  different  trajectory,  were  used  in  the 
bias  estimation  module.  This  was  done  to  determine  the  effect  of  a  trajectory  in  estimating  the 
biases.  The  bias  estimates  from  the  bias  estimation  module  were  input  to  the  bias  correction  mod¬ 
ule  to  align  the  measurements  reported  by  the  sensor.  A  trajectory  which  was  different  from  any  of 
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those  used  to  estimate  the  biases  was  used  in  the  bias  correction  module.  This  was  done  to  deter¬ 
mine  how  well  the  biases  could  be  removed  from  a  track’s  data  when  a  different  track  was  used  to 
generate  the  bias  estimates.  The  bias  corrections  were  performed  in  real  time;  that  is,  as  bias  esti¬ 
mates  were  generated  at  each  time  point,  they  were  then  used  to  align  the  measurements  reported 
by  the  sensor  at  that  same  instant  of  time. 

The  alignment  algorithm  was  tested  using  Monte  Carlo  simulations,  where  each  simulation 
consisted  of  500  experiments.  Various  trajectories  were  used  to  test  the  algorithm.  The  trajectory 
for  the  first  target  is  illustrated  in  Figure  4- 1(a).  This  target  is  flying  along  a  circular  arc  (i.e.,  the 
solid  line  in  Figure  4- 1(a))  at  a  constant  speed  of  20  m/s  and  at  a  constant  altitude  of  2  km.  The 
radius  of  the  circle  along  which  it  is  moving  is  10  km.  The  trajectory  for  the  second  target  is  illus¬ 
trated  in  Figure  4- 1(b).  This  target  is  flying  along  a  straight  line  at  a  constant  speed  of  20  m/s  and 
at  a  constant  altitude  of  2  km.  The  trajectory  for  the  third  target  is  illustrated  in  Figure  4-l(c).  This 
target  is  jinking  and  flying  at  a  constant  altitude  of  2  km.  It  is  moving  with  an  average  speed  of 
22  m/s;  its  speed  has  a  sinusoidal  variation  with  a  period  of  approximately  150  s,  a  minimum 
speed  of  1 1  m/s,  and  a  maximum  speed  of  33  m/s.  Each  of  these  targets  was  used  in  the  bias  esti¬ 
mation  module  to  determine  the  values  of  the  biases.  The  speeds  of  these  targets  were  deliberately 
chosen  to  be  small  (i.e.,  about  20  m/s)  because  it  is  envisioned  that  the  target  used  in  absolute 
alignment  would  be  an  Unmanned  Aerial  Vehicle  (UAV)  or  a  helicopter.  A  trajectory  which  was 
different  from  any  of  those  for  the  previous  three  targets  was  used  in  the  bias  correction  module. 
The  trajectory  used  in  the  bias  correction  module  is  illustrated  in  Figure  4- 1(d).  This  target  is  fly¬ 
ing  along  an  approximate  parabolic  trajectory  at  a  constant  speed  of  100  m/s  and  at  a  constant  alti¬ 
tude  of  2  km. 


4-2 


NSWCDD/TR-96/46 


(a) 


(b) 


(c)  (d) 


FIGURE  4-1.  TARGET  TRAJECTORIES  USED  IN  THE  SIMULATIONS: 

(a)  CIRCULAR,  (b)  STRAIGHT  LINE,  (c)  JINKING,  AND 
(d)  PARABOLIC 


The  sensor  is  located  at  the  origin  (i.e.,  x  =  y  =  0  km)  in  all  of  the  illustrations  in  Figure  4-1 , 
Note  that  the  sensor  has  no  translational  motion.  However,  two  different  rotational  motions  were 
simulated  for  the  sensor.  In  the  first  set  of  tests,  the  simulated  orientation  of  the  sensor  was  given 
by  attitude  angles  that  were  zero  and  did  not  change  with  time;  that  is. 
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p{t)  =  r{t)  =  y{t)  =0  (4-1) 

The  attitude  measurements  were  generated  by  including  bias  errors  and  random  errors  in  the  atti¬ 
tude  angles  of  Equation  (4-1).  This  case  will  be  referred  to  as  the  “static  attitude”  case.  In  ship¬ 
board  applications,  a  sensor  may  have  a  larger  attitude  than  indicated  in  Equation  (4-1)  and  the 
attitude  may  change  with  time.  Thus,  for  the  next  set  of  tests,  the  simulated  orientation  of  the  sen¬ 
sor  was  given  by 

p{t)  =  A  cosfp^^l  r{t)  =  A  cosfp^^  +  ^1  y{t)  =  A  sinf^^H  (4-2) 

where  the  amplitude  A  and  period  T^tt  were  given  by 

A  =  0.1745  rads  =  30  s  (4-3) 

Again,  the  attitude  measurements  were  generated  by  including  bias  errors  and  random  errors  in 
the  attitude  angles  of  Equation  (4-2).  This  will  be  referred  to  as  the  “dynamic  attitude”  case. 

4.2  SENSOR  MEASURING  RANGE,  BEARING,  AND  ELEVATION 

The  tracking  sensor  provided  position  measurements  at  a  periodic  rate  of  1  s.  The  measure¬ 
ments  contained  zero-mean  white  Gaussian  random  errors  with  the  following  standard  deviations; 

Op  =  30  m  =  Op  =  2  millirads  (4-4) 

where  Cr,  and  Cp  are  the  standard  deviations  for  the  random  errors  in  the  bearing  and  elevation, 
respectively,  and  is  the  standard  deviation  for  the  random  error  in  the  range.  The  random 
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errors  in  the  range,  bearing,  and  elevation  were  mutually  uncorrelated.  The  following  constant 
bias  offsets  were  included  in  the  range,  bearing,  and  elevation  measurements: 

^bias  =  25  m  =  15  millirads  =  10  millirads  (4-5) 

A  system  reporting  the  attitude  of  the  sensor  was  simulated  to  provide  the  pitch,  roll,  and 
yaw  angles  at  a  periodic  rate  of  1  s.  The  pitch,  roll,  and  yaw  angles  contained  zero-mean  white 
Gaussian  random  errors  with  the  following  standard  deviations: 

G  =  CT  =  <5  =0.1  millirads  (4-6) 

pry 

where  and  are  the  standard  deviations  for  the  random  errors  in  the  pitch,  roll,  and  yaw 

angles,  respectively.  The  random  errors  in  the  pitch,  roll,  and  yaw  angles  were  mutually  uncorre¬ 
lated.  The  following  constant  bias  offsets  were  included  in  the  pitch,  roll,  and  yaw  angles: 


Pbias  =  5  millirads  =  -5  millirads  (4-7) 

The  absolute  standard  was  simulated  to  provide  precise  location  information  at  a  periodic 
rate  of  1  s  for  both  the  sensor  and  the  targets  used  in  the  bias  estimation  module.  The  (rectangular) 
position  vectors  giving  the  locations  were  expressed  in  the  (true)  stabilized  frame  located  at  the 
true  position  of  the  sensor,  which  had  no  translational  motion.  The  x,  y,  and  z  components  of  the 
position  vectors  reported  by  the  absolute  standard  contained  zero-mean  white  Gaussian  random 
errors  with  the  following  standard  deviations: 


std  std  std  .  ^ 

=  ^  =  =  10m 


(4-8) 


where  ,  and  are  the  standard  deviations  for  the  random  errors  in  the  x,  y,  and  z 

X  y  z 
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components,  respectively.  The  random  errors  in  the  x,  y,  and  z  components  were  uncorrelated.  No 
bias  errors  were  included  in  the  position  vectors  reported  by  the  absolute  standard. 

The  filters  in  the  bias  estimation  module  require  dynamical  models  that  describe  how  the 
biases  change  with  time.  Linear  dynamical  models  were  used  for  both  the  range  bias  and  the 
angular  biases.  A  constant  velocity  model  was  used  for  the  range  bias  dynamics  and  a  constant 
model  was  used  for  the  dynamics  of  the  angular  biases.  Specifically,  these  dynarmcal  models  were 
given  by 


^bias 

1 

T 

^bias^h-0 

0 

1 

(4-9) 


and 


^ang  ( “  ^ang  - 1 )  ■*"  ^ang  -  1 ) 


(4-10) 


where  is  the  time  rate  of  change  of  the  range  bias,  T  =  is  the  sampling  period 

(T  =  1  s  in  the  simulations),  ^ang=  [^bias  hias  Pbias  bias']  is  the  vector  Containing  the 

angular  biases,  is  the  process  noise  vector  for  range  bias  dynamics,  and  y^ang  process 

noise  vector  for  the  angular  bias  dynamics.  These  process  noise  terms  were  assumed  to  be  zero- 
mean  white  Gaussian  processes  with  the  following  covariances: 


cov[)T^(rjt_i)]  =  qji 


7^/3 

7^/2 


7^/2 

T 


I 


f 


[ 
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where  cov  is  the  covariance  operator  and  74  is  the  4  x  4  identity  matrix.  The  values  of  and 
^ang  were  given  by 


qj^  =  0.01  m/s^'^  -  1  microrad/s  (4-12) 

Linear  Kalman  filters  were  used  to  estimate  both  the  range  bias  and  the  angular  biases.  The 
first  data  point  for  the  target  reported  by  the  sensor  was  used  to  compute  the  initial  range  bias  esti¬ 
mate  and  the  first  two  data  points  were  used  to  compute  the  initial  range  bias  rate  estimate.  Subse¬ 
quent  range  bias  and  range  bias  rate  estimates  were  generated  by  the  Kalman  filter  for  the  range 
bias.  The  initial  estimates  used  in  the  Kalman  filter  for  the  angular  biases  were  generated  by  a 
least-squares  estimator  that  processed  the  first  fifty  data  points  for  the  target.  Fewer  data  points 
could  have  been  used  to  initialize  the  filter  for  the  angular  biases;  however,  this  usually  resulted  in 
very  noisy  estimates.  Since  the  computation  of  the  initial  estimates  for  the  angular  biases  used  the 
first  fifty  data  points,  the  initial  estimates  of  the  angular  biases  were  produced  only  after  50  s  of 
data  had  been  reported  by  the  sensor  for  the  target.  Thus,  the  application  of  the  estimated  angular 
biases  in  the  bias  correction  module  occurred  only  after  50  s  of  data  (i.e.,  fifty  data  points)  had 
been  processed  in  the  bias  estimation  module.  In  contrast,  the  application  of  the  estimated  range 
bias  in  the  bias  correction  module  occurred  after  one  data  point  had  been  processed  in  the  bias 
estimation  module. 

The  results  for  the  static  attitude  case  will  be  presented  first.  The  range  bias  results  are 
shown  in  Figure  4-2.  The  range  bias  estimates  for  the  circular  trajectory  appear  in  Figure  4-2(a). 
The  range  bias  estimates  are  denoted  by  the  solid  line,  which  represents  the  average  over  the 
500  experiments.  The  true  value  of  the  range  bias  is  represented  by  the  dashed  line.  The  estimates 
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for  the  straight  line  and  jinking  trajectories  are  not  presented  because  they  are  nearly  identical  to 
those  for  the  circular  trajectory.  The  root-mean-square-error  ^IMSE)  in  the  estimated  range  bias 
is  presented  in  Figure  4-2(b).  The  circles  are  the  results  for  the  circular  trajectory,  the  plus-marks 
for  the  straight  line  trajectory,  and  the  stars  for  the  jinking  trajectory.  The  RMSE  in  the  estimate 
of  a  quantity  x  at  time  t  is  computed  by 


-2_r  (0“^f(0]  (4-13) 

where  (t)  is  the  true  value  of  x  at  time  t,  x.  (t)  is  the  estimated  value  of  x  in  the  experi¬ 
ment  at  time  t,  and  N  is  the  number  of  experiments  in  the  simulation  (N  =  500).  The  estimate  of 
the  range  bias  converges  quickly  to  its  true  value.  The  RMSE  indicates  that  the  steady-state  accu¬ 
racy  of  the  range  bias  is  approximately  5  m,  which  is  comparable  to  the  standard  deviation  output 
by  the  range  bias  filter. 
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FIGURE  4-2.  RANGE  BIAS  FILTER  RESULTS  FOR  THE  STATIC  ATTITUDE 
CASE;  (a)  ESTIMATES  AND  (b)  RMSEs 
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The  estimates  of  the  angular  biases  appear  in  Figure  4-3.  The  results  for  the  circular  trajec¬ 
tory  are  shown  in  (a),  the  straight  line  trajectory  in  (b),  and  the  jinking  trajectory  in  (c).  Again  the 
estimates  are  denoted  by  the  solid  lines,  which  represent  the  averages  over  the  500  experiments, 
and  the  dashed  lines  denote  the  true  values  of  the  biases.  For  the  circular  and  jinking  trajectories, 
the  azimuth  bias  quickly  converges  to  its  true  value,  but  it  takes  about  300  s  to  converge  for  the 
straight  line  trajectory.  The  estimates  of  the  remaining  angular  biases  take  much  longer  to  con¬ 
verge,  about  400  to  500  s.^  Note  that  the  estimates  of  the  angular  biases  contain  much  error  in  the 
first  400  s  for  the  straight  line  trajectory;  much  larger  than  is  observed  for  the  circular  or  jinking 

trajectories.* 


The  RMSEs  in  the  estimates  of  the  angular  biases  are  presented  in  Figure  4-4.  The  circles  are 
the  RMSEs  for  the  circular  trajectory,  the  plus-marks  for  the  straight  line  trajectory,  and  the  stars 
for  the  jinking  trajectory.  Although  the  RMSEs  for  the  straight  line  trajectory  are  initially  an  order 
of  magnitude  larger  than  those  for  the  other  two  trajectories,  they  eventually  settle  down  to  values 
close  to  or  smaller  than  the  ones  for  the  other  two  trajectories;  after  400  s,  the  RMSEs  in  the  ele¬ 
vation,  pitch,  and  roll  biases  for  the  straight  line  trajectory  are  smaller  than  the  RMSEs  for  the 
other  two  trajectories  for  much  of  the  time.  Most  of  the  angular  biases  can  be  determined  to  accu¬ 
racies  of  1  millirad  in  500  to  600  s,  and  to  accuracies  of  0.1  to  0.3  millirads  at  1200  s.  These 
RMSEs  for  the  angular  biases  are  comparable  to  the  standard  deviations  output  by  the  filter  for  the 
angular  biases. 


t  This  is  the  reason  that  a  constant  model  rather  than  a  constant  velocity  model  was  used  for  the  dynamics 
of  the  angular  biases  in  these  simulations.  Several  tests  were  performed  with  a  constant  velocity  model 
and  time- varying  biases,  but  the  convergence  of  the  angular  biases  and  their  rates  took  several  thousands 
of  seconds. 

$  This  probably  is  caused  by  the  smaller  displacement  in  the  bearing  that  initially  occurs  for  the  straight 
line  trajectory  compared  to  the  circular  or  jinking  trajectories.  As  the  straight  line  trajectory  approaches 
the  sensor,  the  displacement  for  the  bearing  increases  (eventually  larger  than  for  the  circular  and  jinking 
trajectories)  and  the  estimation  accuracy  of  the  angular  biases  improves. 
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FIGURE  4-3.  ESTIMATES  OF  THE  ANGULAR  BIASES  FOR  THE  STATIC  ATTITUDE  CASE: 
(a)  CIRCULAR,  (b)  STRAIGHT  LINE,  AND  (c)  JINKING  TRAJECTORIES 


The  bias  estimates  were  input  to  the  bias  correction  module  to  remove  the  biases  from  the 
stabilized  measurements  reported  by  the  sensor  for  the  parabolic  trajectory.  The  results  are  pre¬ 
sented  in  Figure  4-5.  The  unaligned  and  aligned  RMSEs  for  the  range  are  presented  in  (a),  the 
unaligned  and  aligned  RMSEs  for  the  bearing  in  (b),  and  the  unaligned  and  aligned  RMSEs  for 
the  elevation  in  (c).  Here,  “unaligned”  refers  to  the  case  where  the  biases  have  not  been  removed 
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(a)  (b) 
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FIGURE  4-4.  RMSEs  IN  THE  ESTIMATES  OF  THE  ANGULAR  BIASES  FOR  THE 
STATIC  ATTITUDE  CASE:  (a)  AZIMUTH,  (b)  ELEVATION, 

(c)  PITCH,  AND  (d)  ROLL  BIASES 

from  the  stabilized  measurements  for  the  parabolic  trajectory,  while  “aligned”  refers  to  the  case 
where  the  biases  have  been  removed  from  the  stabilized  measurements  in  the  bias  correction 
module  using  the  estimated  biases.  The  circles  are  the  aligned  RMSEs  when  the  circular  trajectory 
is  used  to  estimate  the  biases,  the  plus-marks  are  the  aligned  RMSEs  for  the  straight  line  trajec¬ 
tory,  the  stars  are  the  aligned  RMSEs  for  the  jinking  trajectory,  the  solid  lines  are  the  unaligned 
RMSEs  in  the  stabilized  coordinates,  and  the  dashed  lines  represent  the  values  of  the  standard 
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FIGURE  4-5.  UNALIGNED  AND  ALIGNED  ERRORS  FOR  THE  PARABOLIC 

TRAJECTORY  AND  THE  STATIC  ATTITUDE  CASE:  (a)  RANGE, 
(b)  BEARING,  AND  (c)  ELEVATION 


deviations  in  the  stabilized  coordinates  due  only  to  the  random  error.  The  unaligned  and  aligned 


RMSEs  for  a  quantity  x  at  time  t  are  computed  by 


Unaligned  RMSE  at  time  t  = 


true 


(0 


(4-14) 


and 
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^  ’2 

Aligned  RMSE  at  time  t  =  X  ( 0  -  (t)]  (4-15) 

where  (r)  is  the  true  value  of  x  at  time  t,  (y)  is  the  unaligned  value  of  x  in  the 

experiment  at  time  t,  (t)  is  the  aligned  value  of  x  in  the  experiment  at  time  t,  and  N  is 

the  number  of  experiments  in  the  simulation  (N=  500). 

Since  the  range  bias  is  25  m  and  the  standard  deviation  for  the  random  range  error  is  30  m, 

the  total  error  in  the  range  should  be  39  m  (i.e.,  J  (25  m)^+  (30  m)^ ).  The  average  value  of  the 
unaligned  RMSE  in  the  range  for  the  parabolic  trajectory  is  consistent  with  this  value.  The  aligned 
RMSEs  in  the  range  for  the  parabolic  trajectory  are  nearly  the  same  when  any  of  the  three  trajec¬ 
tories  is  used  to  estimate  the  biases.  Since  the  range  bias  can  be  estimated  to  an  accuracy  of  about 
5  m,  the  total  error  in  the  range  after  alignment  should  be  about  30.4  m  (i.e., 

J  (Sm)^  +  (30  m)^ ).  The  average  values  of  the  aligned  RMSEs  in  the  range  are  consistent  with 
this  value.  The  dashed  line  in  Figure  4-5(a)  represents  the  value  of  the  standard  deviation  in  the 
range  due  only  to  the  random  errors,  which  has  a  value  of  30  m. 

The  unaligned  RMSE  in  the  stabilized  bearing  for  the  parabolic  trajectory  in  Figure  4-5(b)  is 
about  20  millirads.  This  error  is  caused  by  the  bias  errors  in  the  bearing,  elevation,  pitch,  roll,  and 
yaw  angles,  as  well  as  the  random  errors  in  these  angles.  Equation  (3-37)  can  be  used  to  approxi¬ 
mately  determine  the  contribution  of  the  biases  to  the  error  in  the  stabilized  bearing  for  this  case. 
When  the  circular  and  jinking  trajectories  are  used  to  estimate  the  biases,  the  stabilized  bearing 
for  the  parabolic  trajectory  can  be  accurately  aligned  over  the  entire  time  interval.  However,  when 
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the  straight  line  trajectory  is  used  to  estimate  the  biases,  the  error  in  the  aligned  bearing  for  the 
parabolic  trajectory  is  initially  much  larger  than  for  the  unaligned  bearing.  This  occurs  because  of 
the  large  amount  of  estimation  error  in  the  initial  angular  bias  estimates  for  the  straight  line  trajec¬ 
tory.  Thus,  the  performance  is  initially  degraded  by  correcting  the  stabilized  bearing  when  the 
straight  line  trajectory  is  used  to  estimate  the  biases;  that  is,  it  is  better  to  use  the  unaligned  bear¬ 
ing  for  the  first  100  to  150  s  when  the  straight  line  trajectory  is  used  to  estimate  the  biases. 

The  variation  of  the  unaligned  RMSE  in  the  stabilized  elevation  for  the  parabolic  trajectory 
in  Figure  4-5(c)  is  quite  pronounced;  it  varies  from  a  minimum  of  about  4  millirads  to  a  maximum 
of  about  17  millirads.  Equation  (3-38)  can  be  used  to  approximately  determine  the  contribution  of 
the  biases  to  the  error  in  the  stabilized  elevation  for  this  case.  Based  on  Equation  (3-38),  the 
unaligned  RMSE  for  the  elevation  due  to  the  biases  has  a  minimum  value  of  about  3  millirads  at  a 
bearing  of  45  deg;  it  then  increases  quickly  as  the  bearing  increases  and  achieves  a  maximum 
value  of  about  17  millirads  at  a  bearing  of  225  deg;  and  then  it  decreases  as  the  bearing  increases. 
The  bearing  of  the  parabolic  trajectory  has  a  value  of  45  deg  near  the  time  at  which  the  minimum 
RMSE  in  Figure  4-5(c)  occurs;  the  bearing  of  the  parabolic  trajectory  then  increases  and  the 
RMSE  is  observed  to  increase  quickly;  the  bearing  of  the  parabolic  trajectory  has  a  value  of 
225  deg  near  the  time  at  which  the  maximum  RMSE  in  Figure  4-5(c)  occurs;  and  then  the  RMSE 
in  Figure  4-5(c)  decreases  as  the  bearing  increases.  Thus,  the  shape  of  the  parabolic  trajectory 
explains  the  variation  in  the  unaligned  RMSE  for  the  elevation.  The  aligned  RMSEs  indicate  that 
it  takes  about  100  to  150  s  to  accurately  align  the  elevation.  This  occurs  because  it  takes  a  long 
time  for  the  elevation,  pitch,  and  roll  bias  estimates  to  converge,  and  it  is  these  three  bias  estimates 
that  make  the  major  contribution  in  removing  the  bias  errors  in  the  elevation.  Similar  to  the  bear¬ 
ing,  the  error  in  the  aligned  elevation  is  initially  much  larger  than  the  unaligned  elevation  when 
the  straight  line  trajectory  is  used  to  estimate  the  biases. 
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Note  that  there  is  an  increase  in  the  error  for  the  aligned  elevation  between  400  and  800  s 
when  the  circular  or  jinking  trajectories  are  used  to  estimate  the  biases.  This  is  due  to  the  estima¬ 
tion  error  in  the  biases  and  the  shape  of  the  parabolic  trajectory.  Compared  to  the  circular  and 
jinking  trajectories,  this  increase  is  not  as  significant  when  the  straight  line  trajectory  is  used  to 
estimate  the  biases;  the  reason  is  that  the  errors  in  the  estimates  of  the  elevation,  pitch,  and  roll 
bias  estimates  are  usually  much  smaller  between  400  and  800  s  for  the  straight  line  trajectory 
compared  to  the  circular  and  jinking  trajectories  (see  Figure  4-4).  The  increase  is  most  pro¬ 
nounced  for  the  jinking  trajectory  because  the  errors  in  the  estimates  are  generally  largest  for  the 
jinking  trajectory  in  this  time  interval. 

The  results  for  the  dynamic  attitude  case  will  be  presented  next.  The  results  for  the  range 
bias  filter  are  not  shown  because  they  are  nearly  identical  to  those  presented  in  Figure  4-2  for  the 
static  attitude  case.  The  estimates  of  the  angular  biases  appear  in  Figure  4-6.  The  results  for  the 
circular  trajectory  are  shown  in  (a),  the  straight  line  trajectory  in  (b),  and  the  jinking  trajectory  in 
(c).  Note  that  the  initial  estimates  of  the  angular  biases  for  the  straight  line  trajectory  are  more 
accurate  than  for  the  static  attitude  case  (see  Figure  4-3(b)).  This  is  probably  the  result  of  larger 
displacements  in  the  bearing  and  elevation  that  occur  because  of  the  larger  attitude  variations  for 
the  dynamic  attitude  case.  Also,  the  initial  estimates  of  the  elevation,  pitch,  and  roll  biases  for  the 
circular  and  jinking  trajectories  usually  contain  less  error  than  for  the  static  attitude  case.  How¬ 
ever,  for  all  of  the  trajectories,  it  appears  to  take  slightly  longer  for  the  bias  estimates  to  converge 
to  their  true  values  than  for  the  static  attitude  case. 

The  RMSEs  in  the  estimates  of  the  angular  biases  are  presented  in  Figure  4-7.  The  results  are 
similar  to  the  results  obtained  for  the  static  attitude  case,  except  that  the  initial  RMSEs  are  much 
smaller  for  the  dynamic  attitude  case.  This  is  particularly  true  for  the  straight  line  trajectory  (see 
Figure  4-4).  Most  of  the  angular  biases  can  be  determined  to  accuracies  of  1  millirad  in  300  to 
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FIGURE  4-6.  ESTIMATES  OF  THE  ANGULAR  BIASES  FOR  THE  DYNAMIC 
ATTITUDE  CASE:  (a)  CIRCULAR,  (b)  STRAIGHT  LINE,  AND 
(c)  JINKING  TRAJECTORIES 

400  s,  which  is  faster  than  for  the  static  attitude  case,  and  to  accuracies  of  0.1  to  0.3  millirads  at 
1200  s,  which  is  about  the  same  as  for  the  static  attitude  case. 

The  bias  estimates  were  input  to  the  bias  correction  module  to  remove  the  biases  from  the 
stabilized  measurements  reported  by  the  sensor  for  the  parabolic  trajectory.  The  results  are  pre¬ 
sented  in  Figure  4-8.  The  unaligned  and  aligned  RMSEs  for  the  bearing  are  presented  in  (a),  and 
the  unaligned  and  aligned  RMSEs  for  the  elevation  in  (b).  The  unaligned  and  aligned  RMSEs  for 
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(a)  (b) 
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FIGURE  4-7.  RMSEs  IN  THE  ESTIMATES  OF  THE  ANGULAR  BIASES  FOR  THE 
DYNAMIC  ATTITUDE  CASE:  (a)  AZIMUTH,  (b)  ELEVATION, 

(c)  PITCH,  AND  (d)  ROLL  BIASES 


the  range  are  not  presented  because  they  are  nearly  identical  to  those  presented  in  Figure  4-5(a) 
for  the  static  attitude  case.  Note  the  large  oscillatory  variations  in  the  unaligned  RMSEs  in  the 
stabilized  bearing  and  elevation.  Although  the  bearing  and  elevation  are  stabilized  using  the  mea¬ 
sured  attitude  angles,  the  uncompensated  bias  errors  along  with  the  sinusoidal  variation  in  the  atti¬ 
tude  angles  cause  this  oscillatory  variation  in  the  (unaligned)  stabilized  bearing  and  elevation.  The 
stabilized  bearing  for  the  parabolic  trajectory  can  be  accurately  aligned  over  the  entire  time  inter¬ 
val  and  this  does  not  depend  on  the  trajectory  used  to  estimate  the  biases;  the  oscillatory  variation 
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has  also  been  removed  from  the  stabilized  bearing  after  alignment.  The  stabilized  elevation  for  the 
parabolic  trajectory  can  also  be  accurately  aligned.  Again,  there  is  a  slight  increase  in  the  error  in 
the  aligned  elevation  between  400  and  800  s  when  the  circular  and  jinking  trajectories  are  used  to 
estimate  the  biases.  However,  this  increase  in  less  pronounced  in  the  dynamic  attitude  case,  which 
is  due  to  the  more  accurate  bias  estimates  between  400  and  800  s  compared  to  the  static  attitude 
case.  Note  that  the  results  for  both  the  bearing  and  elevation  are  much  better  in  the  first  200  s  for 
the  straight  line  trajectory  than  was  obtained  for  static  attitude  case  (see  Figure  4-5);  this  is  due  to 
the  much  more  accurate  initial  bias  estimates  for  the  straight  line  trajectory  in  the  dynamic  atti¬ 
tude  case. 
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FIGURE  4-8.  UNALIGNED  AND  ALIGNED  ERRORS  FOR  THE  PARABOLIC 
TRAJECTORY  AND  THE  DYNAMIC  ATTITUDE  CASE: 

(a)  BEARING  AND  (b)  ELEVATION 


All  of  the  previous  results  were  based  on  an  absolute  standard  that  had  the  accuracies  pre¬ 
sented  in  equation  (4-8),  which  represents  a  total  position  accuracy  of  about  17  m.  Since  the  accu¬ 
racy  of  the  absolute  standard  may  be  different  (e.g.,  GPS  has  different  accuracies  depending  on  its 
mode  of  operation),  it  is  instructive  to  determine  the  effect  of  the  accuracy  for  the  absolute 
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standard  on  the  alignment  accuracy.  Thus,  another  set  of  simulations  were  performed  for  the  cir¬ 
cular  trajectory  and  for  the  static  attitude  case.  Each  simulation  consisted  of  500  experiments.  The 
same  values  of  the  parameters  presented  in  Equations  (4-4)  to  (4-7)  were  used;  however,  the  total 
positional  standard  deviation  in  the  absolute  standard  was  varied.  Three  different  values  of  the 
total  positional  standard  deviation  in  the  absolute  standard  were  used;  1  m,  30  m,  and  100  m. 

The  accuracies  (i.e.,  RMSEs)  of  the  bias  estimates  are  presented  in  Figure  4-9  for  the  three 
different  positional  standard  deviations  in  the  absolute  standard.  The  circles  are  the  results  for  a 
total  positional  standard  deviation  of  1  m,  the  plus-marks  for  30  m,  and  the  stars  for  100  m.  As 
expected,  the  accuracies  are  best  for  a  positional  standard  deviation  of  1  m,  followed  by  30  m,  and 
then  by  100  m.  The  RMSEs  in  the  range  bias  estimates  for  the  30  m  standard  are  about  20%  larger 
than  the  RMSEs  for  the  1  m  standard,  and  the  RMSEs  in  the  range  bias  estimate  for  the  100  m 
standard  are  about  130%  larger  than  the  RMSEs  for  the  1  m  standard.  For  the  estimates  of  the 
angular  biases,  the  RMSEs  for  the  30  m  standard  are  about  50%  larger  than  the  RMSEs  for  the 
1  m  standard,  and  the  RMSEs  for  the  100  m  standard  are  about  300%  larger  than  the  RMSEs  for 
the  1  m  standard. 

The  bias  estimates  were  input  to  the  bias  correction  module  to  remove  the  biases  from  the 
stabilized  measurements  reported  by  the  sensor  for  the  parabolic  trajectory.  The  results  are  pre¬ 
sented  in  Figure  4-10  for  the  three  different  positional  standard  deviations  in  the  absolute  stan¬ 
dard.  The  RMSEs  for  the  stabilized  range  are  presented  in  (a),  the  RMSEs  for  the  stabilized 
bearing  in  (b),  and  the  RMSEs  for  the  stabilized  elevation  in  (c).  The  x-marks  represent  the 
RMSEs  in  the  unaligned  coordinates,  the  solid  lines  represent  the  standard  deviations  due  only  to 
the  random  errors,  the  circles  represent  the  RMSEs  in  the  aligned  coordinates  for  the  1  m  stan¬ 
dard,  the  plus-marks  represent  the  RMSEs  in  the  aligned  coordinates  for  the  30  m  standard,  and 
the  stars  represent  the  RMSEs  in  the  aligned  coordinates  for  the  100  m  standard.  Clearly,  the 
alignment  accuracy  is  best  for  a  positional  standard  deviation  of  1  m,  followed  closely  by  30  m. 
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FIGXJRE  4-9.  RMSEs  IN  THE  FILTERED  BIAS  ESTIMATES  FOR  THREE  DIFFERENT 
POSITIONAL  ACCURACIES  IN  THE  ABSOLUTE  STANDARD: 
CIRCULAR  TRAJECTORY  AND  STATIC  ATTITUDE  CASE 
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FIGURE  4-10.  UNALIGNED  AND  ALIGNED  ERRORS  FOR  THE  PARABOLIC 
TRAJECTORY  FOR  THREE  DIFFERENT  POSITIONAL 
ACCURACIES  IN  THE  ABSOLUTE  STANDARD:  CIRCULAR 
TRAJECTORY  USED  TO  ESTIMATE  THE  BIASES  AND 
STATIC  ATTITUDE  CASE 


and  then  by  100  m.  However,  it  should  be  noted  that  the  alignment  accuracies  for  the  stabilized 
bearing  are  nearly  the  same  for  all  three  of  the  positional  standard  deviations  after  about  100  to 
150  s.  Also,  the  30  m  standard  produces  nearly  the  same  alignment  as  the  1  m  standard  for  the  sta¬ 
bilized  elevation  and  the  stabilized  range.  The  quality  of  the  alignment  for  the  100  m  standard  is 
poorer  for  the  stabilized  elevation  than  those  of  the  1  m  and  30  m  standards;  the  same  is  true  for 
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the  stabilized  range.  Thus,  marginal  gains  in  the  overall  alignment  quality  are  obtained  in  going 
from  a  30  m  standard  to  a  1  m  standard.  However,  larger  gains  are  obtained  in  going  from  a  100  m 
standard  to  either  a  30  m  or  1  m  standard.  To  illustrate  this,  the  average  values  of  the  unaligned 
and  aligned  RMSEs  in  the  stabilized  coordinates  from  200  to  1142  s  are  presented  in  Table  4-1. 
This  time  interval  was  chosen  so  as  to  minimize  the  effects  of  the  initial  errors  in  the  bias  esti¬ 
mates.  The  30  m  standard  gives  about  98%  of  the  average  alignment  performance  of  the  1  m  stan¬ 
dard.  The  100  m  standard  gives  99%  of  the  average  alignment  performance  of  the  1  m  standard 
for  the  stabilized  bearing,  but  only  about  85%  of  the  performance  for  the  stabilized  range  and  sta¬ 
bilized  elevation. 

TABLE  4-1.  AVERAGE  RMSEs  FOR  THE  UNALIGNED  COORDINATES  AND  THE 
ALIGNED  COORDINATES  IN  THE  PARABOLIC  TRAJECTORY  FOR 
THE  THREE  POSITIONAL  STANDARD  DEVIATIONS  IN  THE 
ABSOLUTE  STANDARD 


Positional  Standard  Deviation  in  the 

Absolute  Standard 

Unaligned 

1  m 

30  m 

100  m 

Stabilized 

Range 

30.3  m 

30.5  m 

31.5  m 

39.0  m 

Stabilized 

Bearing 

2.0  mrad 

2.0  mrad 

2.1  mrad 

19.9  mrad 

Stabilized 

Elevation 

2.3  mrad 

2.5  mrad 

4.3  mrad 

12.8  mrad 

4.3  SENSOR  ONLY  MEASURING  RANGE  AND  BEARING 

The  simulation  of  the  tracking  sensor  only  measuring  range  and  bearing  is  the  same  as 
described  for  the  sensor  in  Section  4.2  except  that  no  elevation  bias  errors  and  no  random  eleva¬ 
tion  errors  were  included  in  the  measurements.  Also,  the  elevation  measurement  was  ignored  in 
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this  case.  The  simulation  of  the  system  reporting  the  attitude  of  the  sensor  and  the  simulation  of 
the  absolute  standard  are  the  same  as  described  in  Section  4.2. 

In  the  bias  estimation  module,  some  of  the  equations  require  the  elevation  of  the  target  as 
reported  by  the  sensor.  However,  the  sensor  provides  no  elevation  for  the  target.  Since  the  loca¬ 
tions  of  the  target  and  the  sensor  are  reported  by  the  absolute  standard,  the  elevation  of  the  target 
in  the  sensor’s  reference  frame  can  be  computed.  This  elevation,  which  is  derived  from  the  loca¬ 
tions  reported  by  the  absolute  standard,  will  be  used  in  the  bias  estimation  module  for  the  target. 
This  implies  that  there  is  no  elevation  bias  and  thus  no  elevation  bibs  needs  to  be  estimated. 

The  difficult  problem  is  in  the  bias  correction  module.  Since  the  absolute  standard  is  only 
assumed  to  provide  the  location  of  the  target  used  in  the  bias  estimation  module,  the  elevations  of 
arbitrary  targets  reported  by  the  sensor  cannot  be  determined.  In  this  case,  the  only  thing  that  can 
be  done  is  to  assign  an  arbitrary  value  to  the  elevation.  Thus,  in  the  bias  correction  module,  the 
elevation  of  the  parabolic  trajectory  will  assigned  the  value  of  zero,  which  of  course  is  not  the  cor¬ 
rect  value. 

Only  the  static  attitude  case  was  simulated.  The  range  bias  results  are  presented  in 
Figure  4-11.  The  range  bias  estimates  for  the  circular  trajectory  appear  in  Figure  4-1 1(a).  The  esti¬ 
mates  for  the  straight  line  and  jinking  trajectories  are  not  presented  because  they  are  nearly  identi¬ 
cal  to  those  for  the  circular  trajectory.  The  RMSEs  in  the  range  bias  estimates  for  the  trajectories 
of  the  three  targets  are  presented  in  Figure  4-1 1(b).  These  results  for  the  estimates  and  the  RMSEs 
for  the  range  bias  are  very  similar  to  the  results  obtained  for  the  sensor  measuring  range,  bearing, 
and  elevation.  This  is  expected  because  the  estimation  of  the  range  bias  is  decoupled  from  the  esti¬ 
mation  of  the  angular  biases  for  both  sensors. 
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FIGURE  4-11.  RANGE  BIAS  FILTER  RESULTS  FOR  A  SENSOR  ONLY 
MEASURING  RANGE  AND  BEARING  FOR  THE  STATIC 
ATTITUDE  CASE;  (a)  ESTIMATES  AND  (b)  RMSEs 


The  estimate  of  the  angular  biases  appear  in  Figure  4-12.  The  results  for  the  circular  trajec¬ 
tory  are  shown  in  (a),  the  straight  line  trajectory  in  (b),  and  the  jinking  trajectory  in  (c).  The  esti¬ 
mates  converge  in  400  to  500  s.  For  the  straight  line  and  jinking  trajectories,  the  estimates  are 
very  inaccurate  in  the  first  300  to  400  s.  For  the  sensor  measuring  range,  bearing,  and  elevation, 
the  initial  estimates  for  the  jinking  trajectory  were  much  more  accurate  (see  Figure  4-3).  The 
decrease  in  the  accuracy  of  the  initial  estimates  for  the  sensor  only  measuring  range  and  bearing  is 
due  to  having  only  one  measurement  equation  (i.e..  Equation  (3-65))  as  opposed  to  having  two 
measurement  equations  (i.e..  Equations  (3-65)  and  (3-66))  for  the  sensor  measuring  range,  bear¬ 
ing,  and  elevation. 

The  RMSEs  in  the  estimates  of  the  angular  biases  are  presented  in  Figure  4-13.  The  circles 
are  the  RMSEs  for  the  circular  trajectory,  the  plus-marks  for  the  straight  line  trajectory,  and  the 
stars  for  the  jinking  trajectory.  The  initial  RMSEs  are  an  order  of  magnitude  larger  than  the 
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FIGURE  4-12.  ESTIMATES  OF  THE  ANGULAR  BIASES  FOR  A  SENSOR  ONLY 
MEASURING  RANGE  AND  BEARING  FOR  THE  STATIC 
ATTITUDE  CASE:  (a)  CIRCULAR,  (b)  STRAIGHT  LINE, 

AND  (c)  JINKING  TRAJECTORIES 


corresponding  RMSEs  for  the  sensor  measuring  range,  bearing,  and  elevation  (see  Figure  4-4). 
For  the  straight  line  trajectory,  most  of  the  biases  can  be  determined  to  accuracies  of  1  millirad  in 
400  to  500  s,  and  to  accuracies  of  0.1  to  0.5  millirads  at  1200  s.  This  is  comparable  to  the  results 
obtained  for  the  sensor  measuring  range,  bearing,  and  elevation.  The  jinking  trajectory  takes 
400  to  800  s  to  obtain  accuracies  of  1  millirad  for  the  various  biases,  and  accuracies  of  0.2  to 
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0.8  millirads  can  be  obtained  at  1200  s.  This  is  slightly  worse  than  the  performance  obtained  for 


the  sensor  measuring  range,  bearing,  and  elevation.  For  the  circular  trajectory,  it  takes  800  to 


1200  s  to  obtain  accuracies  near  1  millirad  for  the  various  biases.  This  is  considerably  worse  than 


the  performance  obtained  for  the  sensor  measuring  range,  bearing,  and  elevation. 


(a) 


(b) 


(c) 


FIGURE  4-13.  RMSEs  IN  THE  ESTIMATES  OF  THE  ANGULAR  BIASES  FOR 
A  SENSOR  ONLY  MEASURING  RANGE  AND  BEARING  FOR 
THE  STATIC  ATTITUDE  CASE:  (a)  AZIMUTH,  (b)  PITCH, 
AND  (c)  ROLL  BIASES 
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The  bias  estimates  were  input  to  the  bias  correction  module  to  remove  the  biases  from  the 
stabilized  measurements  reported  by  the  sensor  for  the  parabolic  trajectory.  The  results  are  pre¬ 
sented  in  Figure  4-14.  The  unaligned  and  aligned  RMSEs  for  the  range  are  presented  in  (a),  and 
the  unaligned  and  aligned  RMSEs  for  the  bearing  in  (b).  The  circles  are  the  aligned  RMSEs  for 
the  circular  trajectory,  the  plus-marks  are  the  aligned  RMSEs  for  the  straight  line  trajectory,  the 
stars  are  the  aligned  RMSEs  for  the  jinking  trajectory,  the  solid  lines  are  the  unaligned  RMSEs  in 
the  stabilized  coordinates,  and  the  dashed  lines  represent  the  values  of  the  standard  deviations  in 
the  stabilized  coordinates  due  only  to  the  random  error. 


TIME  (sec)  TIME  (sec) 

(a)  (b) 


FIGURE  4-14.  UNALIGNED  AND  ALIGNED  ERRORS  IN  THE  PARABOLIC 
TRAJECTORY  FOR  A  SENSOR  ONLY  MEASURING  RANGE 
AND  BEARING  FOR  THE  STATIC  ATTITUDE  CASE: 

(a)  RANGE  AND  (b)  BEARING 


The  results  for  the  stabilized  range  are  very  similar  to  the  results  obtained  for  the  sensor 
measuring  range,  bearing,  and  elevation.  For  the  stabilized  bearing,  the  errors  in  the  aligned 
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bearing  are  initially  much  larger  than  for  the  unaligned  bearing;  that  is,  the  performance  is  ini¬ 
tially  degraded  by  correcting  the  stabilized  bearing.  This  occurs  for  all  three  trajectories  that  were 
used  to  estimate  the  biases.  It  takes  about  400  s  for  the  straight  line  and  jinking  trajectories  to  pro¬ 
duce  an  accurate  alignment  for  the  stabilized  bearing,  and  about  700  s  for  the  circular  trajectory. 
Thus,  it  takes  considerably  longer  to  accurately  align  the  stabilized  bearing  compared  to  the  sen¬ 
sor  measuring  range,  bearing,  and  elevation  (see  Figure  4-5(b)). 

4.4  DISCUSSION 

The  range  bias  is  easily  estimated  using  any  of  the  three  trajectories  considered  in  the  bias 
estimation  module.  The  accuracy  and  convergence  of  the  range  bias  estimates  were  nearly  identi¬ 
cal  for  any  of  the  trajectories  and  nearly  the  same  for  both  the  static  and  dynamic  attitude  cases. 
Also,  the  results  were  nearly  identical  for  the  sensor  measuring  range,  bearing,  and  elevation,  and 
the  sensor  only  measuring  range  and  bearing. 

The  accuracy  and  convergence  of  the  angular  biases  estimates  do  depend  on  the  trajectory 
used  in  the  bias  estimation  module,  the  attitude  of  the  sensor,  and  the  type  of  sensor.  The  estimates 
of  the  angular  biases  were  more  accurate  and  converged  more  quickly  for  the  sensor  measuring 
range,  bearing,  and  elevation  (and,  thus,  also  for  a  sensor  only  measuring  bearing  and  elevation) 
than  for  the  sensor  only  measuring  range  and  bearing  (and,  thus,  also  for  a  sensor  only  measuring 
bearing).  The  decrease  in  accuracy  and  the  longer  convergence  times  for  a  sensor  only  measuring 
range  and  bearing  occurred  because  there  was  only  one  measurement  equation  for  the  angular 
biases  (i.e..  Equation  (3-65))  whereas  the  sensor  measuring  range,  bearing,  and  elevation  had  two 
measurement  equations  for  the  angular  biases  (i.e..  Equations  (3-65)  and  (3-66)). 
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After  the  initial  errors  in  the  bias  estimates  subsided,  the  straight  line  trajectory  usually  pro¬ 
duced  the  most  accurate  estimates  of  the  angular  biases.  This  was  probably  due  to  the  larger  bear¬ 
ing  displacements  between  successive  points  on  the  straight  line  trajectory  as  it  neared  the  sensor. 
Conversely,  during  the  initial  part  of  the  straight  line  trajectory,  the  bearing  displacements  were 
smaller  than  for  the  circular  and  jinking  trajectories,  and  this  was  manifested  by  larger  initial  esti¬ 
mation  errors  in  the  biases  for  the  straight  line  trajectory.  Thus,  it  appears  that  to  obtain  accurate 
bias  estimates  that  also  converge  quickly,  the  trajectory  used  in  the  bias  estimation  module  should 
have  the  largest  possible  bearing  displacements  between  successive  points  on  the  trajectory.  These 
bearing  displacements  are  mainly  influenced  by  the  shape  of  the  trajectory,  by  the  distance  of  the 
trajectory  from  the  sensor,  and  by  the  target  speed.  Future  work  needs  to  be  conducted  in  deter¬ 
mining  the  factors  (e.g.,  trajectory  shape,  distance  from  the  sensor,  target  speed,  etc.)  that  improve 
the  accuracies  of  the  bias  estimates.  As  an  alternative,  one  could  use  two  or  more  targets  simulta¬ 
neously  in  the  bias  estimation  module  to  attempt  to  improve  the  accuracies  of  the  estimates. 

Once  the  biases  were  estimated,  they  were  used  in  the  bias  correction  module  to  align  the 
stabilized  coordinates  of  the  parabolic  trajectory.  The  alignment  of  the  stabilized  range  was 
always  very  good.  After  the  initial  errors  in  the  biases  subsided,  the  alignments  of  the  stabilized 
bearing  and  stabilized  elevation  were  also  fairly  good.  The  only  exceptions  were  the  slight 
increases  in  the  error  for  the  aligned  elevation  between  400  and  800  s  when  the  circular  or  jinking 
trajectories  were  used  to  estimate  the  biases.  This  was  due  to  the  estimation  error  in  the  biases  and 
the  shape  of  the  parabolic  trajectory.  This  problem  was  less  noticeable  for  the  straight  line  trajec¬ 
tory  because  the  estimates  of  the  biases  are  more  accurate  for  the  straight  line  trajectory  in  this 
time  interval.  For  the  sensor  measuring  range,  bearing,  and  elevation  (and  for  a  sensor  only  mea¬ 
suring  bearing  and  elevation),  it  took  about  200  s  to  accurately  align  the  bearing  and  elevation. 
However,  because  of  the  increased  errors  in  the  estimates  of  the  angular  biases,  it  takes  about  400 
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to  600  s  to  accurately  align  the  bearing  for  the  sensor  only  measuring  range  and  bearing  (and  for  a 
sensor  only  measuring  bearing). 

A  study  was  also  conducted  to  determine  the  effects  of  the  accuracy  of  the  absolute  standard 
on  the  alignment.  Absolute  standards  with  total  positional  accuracies  of  1  m,  30  m,  and  100  m 
were  simulated.  As  expected,  the  accuracies  of  the  bias  estimates  were  best  for  the  1  m  standard, 
followed  by  the  30  m  standard,  and  then  by  the  100  m  standard.  The  accuracies  in  the  range  bias 
estimates  for  the  30  m  standard  were  about  20%  larger  than  for  the  1  m  standard,  and  the  accura¬ 
cies  in  the  estimates  of  the  angular  biases  were  about  50%  larger  than  for  the  1  m  standard.  For  the 
100  m  standard,  the  accuracies  in  the  range  bias  estimates  were  about  130%  larger  than  for  the 
1  m  standard,  and  the  accuracies  in  the  estimates  of  the  angular  biases  were  about  300%  larger 
than  for  the  1  m  standard.  In  removing  the  bias  errors  from  the  stabilized  coordinates  of  the  para¬ 
bolic  trajectory,  the  results  for  the  three  standards  were  surprisingly  similar  after  the  initial  errors 
in  the  bias  estimates  subsided.  Of  course,  the  1  m  standard  provided  the  best  overall  performance. 
However,  the  30  m  standard  gave  about  98%  of  the  average  alignment  performance  of  the  1  m 
standard  in  removing  the  biases  from  the  stabilized  measurements  of  the  parabolic  trajectory.  The 
100  m  standard  gave  99%  of  the  average  alignment  performance  of  the  1  m  standard  in  removing 
the  biases  from  the  stabilized  bearing,  and  about  85%  of  the  performance  of  the  1  m  standard  in 
removing  the  biases  from  the  stabilized  range  and  the  stabilized  elevation.  These  numbers  were 
obtained  by  averaging  the  RMSEs  for  the  parabolic  trajectory  from  200  to  1 142  s.  Thus,  in  remov¬ 
ing  the  biases  from  the  stabilized  coordinates  of  the  parabolic  trajectory,  only  marginal  gains  were 
realized  in  going  from  a  30  m  standard  to  a  1  m  standard.  Larger  gains  were  obtained  in  going 
from  a  100  m  standard  to  either  a  30  m  or  a  1  m  standard.  Of  course,  these  numbers  are  averages 
over  a  time  interval  and  apply  only  to  the  parabolic  trajectory.  The  same  conclusions  may  not  hold 
for  other  trajectories  or  at  any  particular  instant  of  time. 
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5.0  SUMMARY 


The  absolute  alignment  problem  was  examined  in  this  report.  An  algorithm  was  developed 
for  absolutely  aligning  the  positional  data  reported  by  a  tracking  sensor  using  a  target  whose  loca¬ 
tion  is  measured  by  the  sensor  and  whose  location  can  also  be  precisely  determined  by  some  tech¬ 
nique  independently  of  the  sensor’s  measurements.  This  algorithm  also  required  the  location  of 
the  sensor  to  be  precisely  known.  Any  differences  between  the  sensor-reported  position  for  the 
target  and  its  independently  determined  precise  location  were  attributed  to  bias  errors  in  the  posi¬ 
tional  data  reported  by  the  sensor.  These  differences  were  then  used  to  estimate  the  bias  errors  in 
the  positional  data  reported  by  the  sensor.  A  potential  candidate  for  providing  precise  location 
information  independently  of  the  sensor’s  measurements  is  GPS.  However,  the  algorithm  is  appli¬ 
cable  to  any  technique  that  provides  precise  location  information  independently  of  the  sensor’s 
measurements. 

The  absolute  alignment  algorithm  consisted  of  two  basic  modules:  (1)  the  bias  estimation 
module,  and  (2)  the  bias  correction  module.  The  bias  estimation  module  was  used  to  estimate  the 
bias  errors  using  the  difference  between  a  target’s  sensor-reported  position  and  its  independently 
determined  precise  location.  Two  decoupled  filters  were  used  in  the  bias  estimation  module  to 
estimate  the  biases:  a  filter  to  estimate  the  range  bias  and  another  one  to  estimate  the  angular 
biases.  The  bias  correction  module  received  estimates  of  the  biases  from  the  bias  estimation  mod¬ 
ule  and  then  used  these  estimates  to  remove  the  biases  from  the  sensor-reported  positional  data. 
Note  that  the  bias  correction  module  corrects  the  positional  data  for  all  of  the  targets  reported  by 
the  sensor,  not  only  the  target  used  to  estimate  the  biases. 
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Simulations  were  used  to  illustrate  the  performances  of  the  absolute  alignment  algorithms 
for  the  four  most  common  types  of  tracking  sensors  providing  positional  data.  Various  trajectories 
were  used  in  the  bias  estimation  module  to  determine  the  effects  of  a  trajectory  in  estimating  the 
biases.  Specifically,  circular,  straight  line,  and  jinking  trajectories  were  used  in  the  bias  estimation 
module.  The  range  bias  was  easily  estimated  using  any  of  the  trajectories.  The  accuracy  and  con¬ 
vergence  of  the  range  bias  estimate  were  nearly  identical  for  any  of  the  trajectories.  However,  the 
accuracy  and  convergence  of  the  angular  biases  estimates  did  depend  on  the  trajectory  and  the 
type  of  sensor  reporting  the  positional  data.  The  estimates  of  the  angular  biases  were  more  accu¬ 
rate  and  converged  more  quickly  for  the  sensor  measuring  range,  bearing,  and  elevation  (and, 
thus,  also  for  a  sensor  only  measuring  bearing  and  elevation)  than  for  the  sensor  only  measuring 
range  and  bearing  (and,  thus,  also  for  a  sensor  only  measuring  bearing).  The  decrease  in  accuracy 
and  the  longer  convergence  times  for  a  sensor  only  measuring  range  and  bearing  occurred  because 
there  was  only  one  measurement  equation  for  the  angular  biases  whereas  the  sensor  measuring 
range,  bearing,  and  elevation  had  two  measurement  equations  for  the  angular  biases. 

After  the  initial  errors  in  the  bias  estimates  subsided,  the  straight  line  trajectory  usually  pro¬ 
duced  the  most  accurate  estimates  of  the  angular  biases.  This  was  probably  due  to  the  larger  bear¬ 
ing  displacements  between  successive  points  on  the  straight  line  trajectory  as  it  neared  the  sensor. 
Conversely,  during  the  initial  part  of  the  straight  line  trajectory,  the  bearing  displacements  were 
smaller  than  for  the  circular  and  jinking  trajectories,  and  this  was  manifested  by  larger  initial  esti¬ 
mation  errors  in  the  biases  for  the  straight  line  trajectory.  Thus,  it  appears  that  to  obtain  accurate 
bias  estimates  that  also  converge  quickly,  the  trajectory  used  in  the  bias  estimation  module  should 
have  the  largest  possible  bearing  displacements  between  successive  points  on  the  trajectory.  These 
displacements  are  mainly  influenced  by  the  shape  of  the  trajectory,  by  the  distance  of  the  trajec¬ 
tory  from  the  sensor,  and  by  the  target  speed.  Future  work  needs  to  be  conducted  in  determining 
the  factors  (e.g.,  trajectory  shape,  distance  from  the  sensor,  target  speed,  etc.)  that  improve  the 
accuracies  of  the  bias  estimates. 
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The  bias  estimates  were  input  to  the  bias  correction  module  to  align  the  stabilized  measure¬ 
ments  reported  by  the  sensor.  A  trajectory  which  was  different  from  any  of  those  used  to  estimate 
the  biases  was  used  in  the  bias  correction  module.  This  was  done  to  determine  how  well  the  biases 
could  be  removed  from  a  track’s  measurements  when  a  different  track  was  used  to  generate  the 
bias  estimates.  Specifically,  a  target  with  an  approximate  parabolic  trajectory  was  used  in  the  bias 
correction  module.  The  alignment  of  the  stabilized  range  was  always  very  good.  After  the  initial 
bias  errors  subsided,  the  alignments  of  the  stabilized  bearing  and  the  stabilized  elevation  were  also 
good.  For  the  sensor  measuring  range,  bearing,  and  elevation  (and  a  sensor  only  measuring  bear¬ 
ing  and  elevation)  it  took  about  200  s  (i.e.,  200  data  points)  before  the  bearing  and  elevation  were 
accurately  aligned.  However,  for  the  sensor  only  measuring  range  and  bearing  (and  a  sensor  only 
measuring  bearing),  it  took  about  400  to  600  s  (i.e.,  400  to  600  data  points)  to  accurately  align  the 
bearing.  This  was  due  to  the  larger  estimation  errors  in  the  angular  biases  for  the  sensor  only  mea¬ 
suring  range  and  bearing. 

A  study  was  also  conducted  to  determine  the  effects  of  the  accuracy  of  the  absolute  standard 
on  the  alignment.  Absolute  standards  with  total  positional  accuracies  of  1  m,  30  m,  and  100  m 
were  simulated.  As  expected,  the  accuracies  of  the  bias  estimates  were  best  for  the  1  m  standard, 
followed  by  the  30  m  standard,  and  then  by  the  100  m  standard.  The  aceuracies  in  the  range  bias 
estimates  for  the  30  m  standard  were  about  20%  larger  than  for  the  1  m  standard,  and  the  accura¬ 
cies  in  the  estimates  of  the  angular  biases  were  about  50%  larger  than  for  the  1  m  standard.  For  the 
100  m  standard,  the  accuracies  in  the  range  bias  estimates  were  about  130%  larger  than  for  the 
1  m  standard,  and  the  aecuracies  in  the  estimates  of  the  angular  biases  were  about  300%  larger 
than  for  the  1  m  standard.  In  removing  the  bias  errors  from  the  stabilized  coordinates  of  the  para¬ 
bolic  trajectory,  the  results  for  the  three  standards  were  surprisingly  similar  after  the  initial  errors 
in  the  bias  estimates  subsided.  Of  course,  the  1  m  standard  provided  the  best  overall  performance. 
However,  the  30  m  standard  gave  about  98%  of  the  average  alignment  performance  of  the  1  m 
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standard  in  removing  the  biases  from  the  stabilized  measurements  of  the  parabolic  trajectory.  The 
100  m  standard  gave  99%  of  the  average  alignment  performance  of  the  1  m  standard  in  removing 
biases  from  the  stabilized  bearing,  and  about  85%  of  the  performance  of  the  1  m  standard  in 
removing  the  biases  from  the  stabilized  range  and  the  stabilized  elevation.  Thus,  in  removing  the 
biases  from  the  stabilized  coordinates  of  the  parabolic  trajectory,  only  marginal  gains  were  real¬ 
ized  in  going  from  a  30  m  standard  to  a  1  m  standard.  Larger  gains  were  obtained  in  going  from  a 
100  m  standard  to  either  a  30  m  or  1  m  standard.  Of  course,  these  numbers  are  averages  over  a 
time  interval  and  apply  only  to  the  parabolic  trajectory.  The  same  conclusions  may  not  hold  for 
other  trajectories  or  at  any  particular  instant  of  time. 

Finally,  the  algorithms  developed  in  this  report  can  also  be  applied  to  the  relative  alignment 
problem  provided  that  there  are  no  bias  errors  in  the  locations  of  the  sensors  and  that  the  master 
sensor  is  a  sensor  measuring  range,  bearing,  and  elevation.  In  this  case,  the  master  sensor  measur¬ 
ing  range,  bearing,  and  elevation  would  play  the  role  of  the  absolute  standard  in  the  algorithms 
developed  in  this  report.  The  resulting  relative  alignment  algorithms  will  be  more  general  than  the 

ones  developed  by  Helmick  et  alj'^  and  thus  supersedes  them.  For  example,  they  assumed  that 
the  bias  errors  were  small  and  that  the  pitch,  roll,  and  yaw  angles  were  also  small.  None  of  these 
assumptions  were  used  to  develop  the  general  nonlinear  algorithm  presented  in  this  report.  Of 
course,  the  linear  algorithm  presented  in  this  report  did  assume  that  the  angular  biases  were  small. 
Also,  they  assumed  that  the  distances  between  the  sensors  were  small  (i.e.,  co-located).  This 
would  not  be  a  limitation  in  the  new  relative  alignment  algorithms  because  the  alignment  would 
be  performed  in  the  stabilized  frame  of  the  sensor  to  be  relatively  aligned.  In  this  case,  the  data 
reported  by  the  master  sensor  would  be  transformed  to  the  other  sensor’s  stabilized  frame  and  this 
leads  to  our  requirements  that  the  master  sensor  provide  full  three  dimensional  information  for  the 
position  and  that  there  be  no  bias  errors  in  the  locations  of  the  sensors.  Thus,  the  new  relative 
alignment  algorithms  would  also  apply  to  widely  separated  sensors 
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